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The  study  reported  in  this  thesis  investigates  the  potential 
advantages  of  integrated  design  strategies  for  flexible  manipulators  that 
utilize  a controller  in  the  process  of  optimizing  the  structural  design. 

A clamped  free  beam  model  with  torque  inputs  at  the  joints  and 
disturbances  at  the  link  ends  is  considered  in  the  investigation.  A clamped 
mass  beam  model  is  also  investigated.  A proportional  and  derivative 
controller  is  utilized  in  the  design  process  with  several  objective  functions 
that  incorporate  weighted  combinations  of  the  mass  of  the  structure,  modal 
mass,  modal  stiffness,  and  the  natural  frequency  of  the  rigid  and  flexible 
modes.  The  results  show  that  the  objective  function,  which  minimizes  mass 
and  maximizes  the  product  of  the  modal  mass  and  the  modal  stiffness  with 


appropriate  weighting  factors,  gave  the  best  dynamic  performance.  It  was 
also  shown,  as  would  be  expected,  that  the  selection  of  the  weighting 
factors  is  an  important  consideration  since  it  can  significantly  influence  the 
dynamic  characteristics  of  the  optimized  system. 

Although  a two  link  tubular  planar  manipulator  with  a PD  controller 
and  assumed  beam  models  for  the  links  is  considered  in  the  optimization 
based  on  modal  parameters,  the  reported  approach  can  be  extended  to  time 
domain  optimization  of  multi-link  spacial  robots  with  complex  structures 
designed  to  perform  particular  tasks. 


VI 


CHAPTER  1 
INTRODUCTION 


The  structural  designs  of  existing  industrial  robots  incorporate  direct 
methods  to  minimize  system  vibration  through  relatively  stiff  links  and 
drives.  This  design  approach  provides  good  static  performance  but  also 
makes  the  robot  massive.  Massiveness  lowers  the  system  dynamic 
performance  and  increases  power  consumption.  In  some  applications  a 
light-weight  robot  is  more  attractive  despite  its  reduced  stiffness.  Robots 
in  space  applications  require  light,  long  arms  to  be  controlled  with  low 
energy  in  a wide  operating  range  and  good  performance.  Nuclear  plants 
require  light,  long  arms  for  access  to  areas  of  high  radiation.  In  small 
products  applications,  the  electric  circuit  chip  mounter  needs  a high-speed 
manipulator  making  a light  structure  necessary. 

The  light-weight  manipulator  has  many  advantages  such  as  low 
power  consumption,  a smaller  actuator,  more  compact  link  design,  lower 
system  inertia,  and  less  mass  to  be  transported.  Therefore,  it  can  benefit 
from  an  improvement  in  rigid  mode  dynamics.  The  principal  disadvantage 
is  reduced  accuracy  in  end-point  control.  Due  to  this  accuracy  drawback 
and  the  complexity  of  the  modeling,  light  robots  received  little  attention 
until  the  end  of  the  1970s.  Since  their  use  in  a space  manipulator. 
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considerable  research  has  been  performed  particularly  in  the  control  area. 
An  historical  review1-’  has  provided  general  information  on  the  modeling 
of  the  flexible  manipulator,  manipulator  parametric  studies,  some  of  the 
design  approaches  and  efficient  control  algorithms,  etc. 

The  general  approach  for  the  design  of  manipulators  is  based  on 
kinematics,  stress  analysis,  and  structural  analysis.  The  classical  design 
leads  to  an  optimal  structure  from  the  mechanical  viewpoint.  Optimization 
of  the  system  through  the  statics  and  the  dynamics  of  the  mechanical 
system  does  not  guarantee  that  the  manipulator  system  is  optimal  within  a 
control  loop.  The  total  system  overview  and  the  structural  design  of  the 
clamped  body  including  controller  effects  have  received  attention  in 
aerospace  research  since  the  middle  of  the  1980s.  Manipulator  designs  that 
include  controller  effects  began  in  the  early  1990s.  The  work  proposed  in 
this  study  will  treat  the  problem  by  optimizing  the  system  for  minimum 
vibration  from  the  structural  design  viewpoint.  The  manipulator  design 
further  encompasses  the  rigid  mode  controller  effects  at  the  design  stage. 

Most  existing  robots  are  controlled  by  means  of  independent  joint 
controllers  based  on  classical  control  concepts  such  as  PID  control,  robust 
control,  etc.  Vibration  control  of  industrial  robots  and  space  manipulators 
is  achieved  by  moving  joints  slowly  and  waiting  until  the  end  effector 
settles  down.  If  the  robot  is  stiff  enough,  the  deflection  can  be  neglected 
and  a controller  based  on  the  rigid  mode  is  usually  adequate.  In  light- 
weight robots,  deflection  is  not  negligible,  but  there  are  several  methods  to 
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solve  the  problem.  An  additional  active  controller  may  quickly  reduce 
structural  deflection.  A slow  controller  may  avoid  exciting  the  flexible 
mode.  Manipulator  flexibility  can  go  inside  or  outside  of  a control  loop. 
When  flexibility  is  inside  a control  loop,  then  the  stability  of  the  system 
requires  careful  checking.  This  study  includes  the  flexibility  of  the 
manipulator  in  the  design  process. 

A simple  controller  is  developed  based  on  general  control  and 
optimization  theory.  The  proportional  and  derivative  controller  is  used  due 
to  its  simple  structure  and  the  structural  benefits  it  can  provide  in  the 
design  stage.  This  controller  is  used  in  the  design  stage  to  modify  the 
manipulator  dimensions,  optimizing  them  based  on  structural 
considerations.  The  resulting  system  with  controller  effects  is  expected  to 
undergo  minimum  vibration  in  both  the  rigid  and  the  flexible  body  modes. 

The  research  direction  of  this  study  is  first  to  model  the  flexible 
manipulator  with  the  assumed  mode  method  and  to  investigate  further  the 
structural  characteristics  of  the  manipulator  through  various  boundary  and 
system  input  conditions.  These  structural  parameters  then  are  used  to 
achieve  an  optimal  structural  design.  This  study  focuses  on  an  integrated 
design  approach  where  a controller  is  used  in  the  design  stage  to  improve 
system  performance  inside  a control  loop. 


CHAPTER  2 
LITERATURE  REVIEW 

Modeling 

The  modeling  of  the  manipulator  is  the  first  step  in  the  design  and 
control  ot  a system.  Proper  modeling  of  a system  is  necessary  for 
predicting  performance  characteristics  as  influenced  by  design  control 
parameters.  The  robot  structure  can  be  divided  into  several  components 
such  as  joints,  drives,  and  links.  These  can  be  treated  as  rigid  structures  or 
flexible  structures  depending  on  the  relative  effects  of  the  flexibility. 
Researchers  usually  choose  a model  that  best  fits  their  objective.  Potential 
models  for  the  manipulator  can  be  categorized  in  the  following  way: 

(a)  Rigid  joint  and  rigid  link  model 

(b)  Flexible  joint  and  rigid  link  model 

(c)  Rigid  joint  and  flexible  link  model 

(d)  Flexible  joint  and  flexible  link  model 

Most  industrial  researchers  use  the  model  that  has  rigid  joints  and  rigid 
links.  The  links  and  the  joints  in  most  applications  are  designed  to  be  as 
massive  as  possible  in  order  to  increase  stiffness.  The  merits  of  this  type 
of  manipulator  are  the  simple  dynamics  of  the  system  and  good  position 
accuracy  so  that  open  loop  control  schemes  are  possible.  The  disadvantage 


4 


5 

is  the  low  level  of  system  responsiveness  to  rapid  tasks.  Numerous  studies 
have  been  done  on  the  design,  control,  sensing,  and  vision  of  rigid  robot 
systems.4  Industrial  robot  researchers  are  interested  in  modeling  and 
control  from  a practical  standpoint.  The  exact  model  of  a manipulator  is 
often  complex  and  requires  high-powered  computing  to  perform  real  time 
estimation.  That  is  why  the  simple  model  based  on  the  rigid  mode  is 
preferred.  The  effects  of  the  unmodeled  characteristics  in  the  simple  model 
could  be  reduced  by  robust  control  schemes.5 

A more  realistic  model  of  the  industrial  robot  is  the  flexible  joint  and 
rigid  link  model.  The  sources  of  joint  compliance  are  shafts,  gear  trains, 
harmonic  drives,  chain  drives  and  others.  Considerable  research  has  been 
undertaken  to  study  the  effects  of  joint  compliance.  Sweet  and  Good*’  and 
Good  et  al.7  showed  that  flexibility  of  the  drive  system  is  the  dominant 
source  of  compliance  in  the  industrial  robot,  GE-P50.  Their  fourth-order 
dynamic  model  was  derived  through  experiments.  The  model  shows 
resonances  in  the  5 - 8 Hz  range  because  of  flexibility  in  the  harmonic 
drives,  which  is  not  considered  in  conventional  rigid  mode  robot  models. 
The  nonlinear  vibratory  response  of  a two  link  robot  manipulator  with 
compliance  in  its  joints  has  also  been  investigated  by  other  researchers.8  9 

Link  compliance  is  significant  in  manipulators  with  slender  links  as  in 
the  case  of  the  space  shuttle  remote  robot.  One  of  the  pioneering  research 
on  the  flexible  link  manipulator  was  done  by  Book  et  al.10  who  used  a 
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planar,  nonlinear  model  with  modal  representation  of  flexibility  to  analyze 
the  performance  of  control  schemes.  Smart  and  Wiens11  investigated 
gravitational  effects  on  the  natural  frequencies  and  the  static  deflections  of 
two  link  flexible  system  with  clamped  mass  model.  Barbieri  and  Ozguner12 
investigated  mode  shapes  for  a flexible  slewing  link.  Constrained  and 
unconstrained  mode  expansions  were  investigated  by  changing  system 
inertia  in  the  absence  of  any  controller  dynamics.  Oakley  and  Cannon13 
presented  equations  of  motion  for  a planar  two  link  configuration  by  using 
Kane’s  dynamic  equations.  A novel  approach  for  representing  the  mode 
shapes  of  the  manipulator  was  presented  with  a system  modes 
representation. 

The  most  complex  model  for  a manipulator  is  the  flexible  joint  and 
flexible  link.  This  model  is  the  most  realistic  but  is  seldom  used  in  design 
and  control  because  of  the  complexity  of  its  system  equations.7  Ding  et 
al.  derived  a general  dynamic  model  for  a large  class  of  flexible  robot 
arms  incorporating  joint  and  link  elasticity.  Some  control  schemes  were 
based  on  this  model  and  investigated  via  simulation,15  but  the  controllers 
employing  joint  and  link  flexibility  can  not  meet  the  computational 
requirements  for  real-time  implementation. 

Design 

The  industrial  sector  has  undertaken  considerable  research  into 
mechanical  designs  of  robots.16  Traditional  design  approaches  add  material 
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to  increase  the  manipulator’s  stiffness  and  the  strength.  This  conservative 
approach  can  improve  positioning  accuracy,  but  large  mass  and  inertia 
result  in  reduced  dynamic  performance.  The  demand  for  fast,  accurate 
manipulators  requires  designs  of  structurally  advanced  manipulators. 

A general  review  has  surveyed  designs  of  light  weight 
manipulators.1^  The  paper  by  Book  et  al  17  presents  general  strategies  on 
solving  design  and  control  problems  of  light-weight  arms.  They  divided 
problems  of  light  manipulators  into  four  categories:  material  and  shape, 
feedback  control  algorithms,  strategies  of  arm  use,  and  arm  trajectories. 
Their  method  to  improve  structural  damping  uses  viscoelastic  material  and 
a length-optimized  constraining  layer. 

One  approach  for  an  advanced  structure  uses  composite  materials. 
Dunbar  et  al.18  introduced  the  use  of  composite  material  for  designing 
booms  in  the  space  shuttle’s  remote  manipulator  system.  Ultra-high 
modulus  graphite/epoxy  was  chosen  to  meet  stiffness  requirements  within 
weight  constraints.  A paper  by  Hunter  et  al.13  describes  the  design 
considerations  for  the  shuttle’s  remote  manipulator  system.  The  total 
weight  of  the  manipulator,  the  maximum  diameter  of  the  arm  booms,  and 
the  stiffness  of  the  arm  booms  are  discussed  as  constraints.  Saravanos  and 
Lamancusa"  proposed  a design  method  for  predicting  the  optimum 
configuration  of  the  ply  angle  and  ply  thickness  in  serial  links.  This  design 
goal  simultaneously  maximizes  the  end  effector  stiffness  and  payload 
carrying  capacity  of  composite  robotic  manipulators  through  changes  in  ply 
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configuration.  Their  design  methodology  is  applied  to  a SCARA-class 
manipulator  for  illustration  of  its  effectiveness. 

Model  order  reduction  is  an  interesting  approach  to  shorten  the 
structural  design  process.  Paz21  introduced  an  algorithm  for  modal 
condensation  that  transforms  systems  with  a high  degree  of  freedom  into 
systems  with  a relatively  low  degree  of  freedom  through  checking  residual 
energy  for  perturbations.  Equations  producing  little  energy  are  neglected 
because  of  their  lack  of  effect  on  the  entire  structure.  Kim22  applied  the 
modal  condensation  method  to  the  structural  redesign  of  a uniform  curved 
shell  segment.  The  thicknesses  of  the  shell  elements  are  redesigned  to 
minimize  the  vibration  of  a certain  mode  at  a particular  point. 

When  a system  is  more  complex,  a systematic  method  is  needed  for 
design.  Sobieski  et  al.23  structurally  designed  three-beam  elements  through 
multilevel  optimization,  a method  which  partitions  a structure  into  a 
number  of  substructuring  levels.  A three-beam  structure  is  divided  into 
three  levels:  a bottom  level  representing  the  plates,  a middle  level  for  the 
beams,  and  a top  level  for  the  assembled  structure.  Each  level  has  different 
objective  functions,  design  variables,  and  constraints. 

Some  researchers  include  control  theory  into  the  design  stage  to 
improve  pertormance.  Jaliwala  et  al.24  presented  the  idea  of  using  control 
theory  to  optimize  a machine  element.  A cam  follower  mechanism  is 
modeled  as  a closed  loop  control  system.  The  cam  shape  is  designed  by 
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minimizing  the  error  between  the  ideal  and  the  actual  follower  lift.  Haftka 
et  al.25  performed  a structural  modification  for  a cruciform  beam  that  was 
supported  by  cables  and  was  controlled  by  several  rate-feedback  collocated 
sensor-actuator  pairs.  Active  damping  in  the  flexible  modes  is  created  by 
the  rate-feedback  controller  rather  than  structural  damping.  The  sensitivity 
of  the  active  damping  gains  to  minor  structural  modifications  are 
calculated;  the  thicknesses  of  highly  sensitive  elements  consequently  are 
changed.  The  control  efforts  are  reduced  due  to  the  low  gains  in  the 
flexible  mode  controller  by  changing  the  masses  of  sensitive  elements. 

The  dynamics  of  the  structure  can  be  altered  through  the  dynamics  of 
the  controller.  Interactions  between  controller  and  structure  are  receiving 
attention  in  an  effort  to  improve  total  system  performance.  Spanos26 
investigated  control-structure  interaction  problems  via  stability  analysis  of 
a linear  servo-loop  model.  Structural  flexibility  is  categorized  into  three 
types  based  on  the  magnitude  and  the  location  of  zero  in  the  s-plane.  The 
stability  of  these  systems  is  investigated  by  changing  the  relations  between 
the  closed  loop  bandwidth  and  the  modal  frequency  of  the  structure. 
Sensors,  filters,  and  PD  controller  are  included  to  change  the  closed  loop 
bandwidth.  Dyke  et  al.27  investigated  control-structure  interactions  and 
performed  examples  of  including  control-structure  interaction  in  protective 
system  design.  Hydraulic  actuators  are  modeled  in  three  different  ways  and 
applied  to  the  prototype  with  three  active  control  systems.  A natural 
velocity  feedback  link  is  modeled  to  represent  the  interaction  between  the 
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hydraulic  actuators  and  the  structures.  Their  examples  showed  better 
system  performances  by  accounting  for  control-structure  interaction  and 
actuator  dynamics. 

A study  of  control-structure  interaction  resulted  in  a different 
approach  for  the  design  of  the  manipulators.  Park  and  Asada28'29  presented 
a new  transmission  mechanism  for  a single  link  flexible  arm.  The  endpoint 
positioning  of  a flexible  arm  produces  a non-minimum  phase  system,  which 
is  difficult  to  stabilize.  The  proposed  torque  transmission  mechanism 
transformed  the  single  link  flexible  arm  to  a minimum  phase  system  so  that 
control  is  easier  than  in  regular  flexible  arms.  The  unstable  zeros  of  the 
control  system  are  removed  by  relocating  the  torque  actuation  point. 

A number  of  studies  on  the  integration  of  structure  and  control 
design  were  conducted  from  the  middle  1980s  to  the  early  1990s, 
particularly  concerning  large  space  structures.  Most  of  the  mechanisms 
investigated  in  this  area  were  clamped  structures  and  the  flexible  modes  are 
controlled  by  time  domain  control  schemes.  LQ-based  control  is  the 
dominant  control  scheme  with  the  feedback  of  flexible  modes  because  it  fits 
well  with  the  structure  of  the  objective  function  for  the  optimization 
problems.  Khot  et  al.  proposed  an  algorithm  to  design  a minimum-weight 
structure  with  a constraint  on  the  damping  parameter  of  the  closed  loop 
system.  Closed  loop  system  equations  of  large  flexible  structures  are 
calculated  with  the  feedback  of  flexible  mode  responses.  A controller 
employing  a linear  quadratic  regulator  is  utilized;  the  performance  index 


11 


for  the  controller  is  chosen  to  find  the  optimum  gain  matrix  through  a 
compromise  between  minimum  error  and  minimum  energy  criteria.  After  a 
closed  loop  control  system  is  completed,  the  gradients  of  the  damping 
factors  are  checked  by  changing  the  cross-sectional  area  and  a minimum- 
weight  structure  is  found  within  the  damping  constraints.  McIntosh  and 
Floyd  1 have  developed  a technique  for  a least-weight  optimal  design  of  a 
tubular-truss  space  structure  with  constraints  on  its  natural  frequencies  and 
its  open  loop  disturbance  rejection  properties.  The  disturbance  rejection 
properties  of  the  structure  are  measured  by  a special  function,  disturbance- 
to-regulated- variable  grammians.  Kosut  et  al.32  showed  another  strategy 
for  vibration  suppression  due  to  disturbances.  The  structural  parameters 
for  disturbance  attenuation  are  chosen  to  reduce  the  necessary  control 
authority.  The  ratio  of  two  transfer  functions  (the  output  over  the 
disturbance  and  the  output  over  the  input  torque)  is  used  to  seek  the 
minimum  objective  function  value. 

The  integrated  structure  and  control  design  is  extended  with 
different  strategies.  Bodden  and  Junkins"  proposed  a group  eigenvalue 
optimization  approach  for  a high-order  system  by  using  structure  and 
controller  design  iterations.  The  modal  matrix  that  includes  eigenvalues 
and  eigenvectors  is  used  for  the  structural  and  the  control  optimality 
criteria.  Exact  eigenvalue  placement  or  pole  placement  is  not  a reasonable 
design  approach  for  a high-order  system;  as  a consequence  they  undertook 
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a more  reasonable  approach  that  moves  all  of  the  eigenvalues  into  an 
acceptable  region  of  the  complex  plane.  Other  researchers  have  extended 
the  integrated  optimization  approach.  Lim  and  Junkins34  included  a new 
design  algorithm  for  numerical  applications  incorporating  stability 
robustness  measures.  They  compared  the  robustness  of  optimization 
schemes  through  stability  robustness  and  eigenvalue  sensitivity.  The 
results  indicate  that  maximizing  a stability  robustness  measure  produces 
more  robust  designs  than  directly  minimizing  the  eigenvalue  sensitivity. 
Three  different  cost  functions  (total  mass,  stability  robustness,  and 
eigenvalue  sensitivity)  are  optimized  with  respect  to  a set  of  design 
parameters  that  include  the  structural  and  control  parameters  and  actuator 
locations.  Miller  and  Shim'5  presented  a simultaneous  structural  and 
control  optimization.  The  objective  function  is  a combination  of  mass  and 
total  system  strain  and  of  kinetic  and  control  energies  with  an  appropriate 
weighting  factor.  Ten  bar  truss  is  adopted  for  a numerical  example  with 
linear  quadratic  control.  The  objective  function  is  calculated  through  a 
gradient-based  search. 

Considerable  research  exists  on  the  integrated  structure  and  control 
design  of  space  structures.  Gilbert  and  Schmidt36  presented  general 
information  on  multilevel  structure  and  control  design.  They  have 
proposed  a new  approach  as  an  alternative  to  both  the  simultaneous  and  the 
sequential  integrated  control  and  structure  design  methods.  The  structure 
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and  the  control  laws  are  designed  independently  and  integration  of  the  two 
properties  is  achieved  through  a special  optimization  formulation  so  that 
their  method  utilizes  multilevel  optimization. 

Another  integrated  approach  is  structural  tailoring.  Belvin  and 
Park'7  proposed  a method  for  optimization  of  a closed  loop  structural 
system  using  structural  tailoring.  This  paper  described  a choice  of 
weighting  matrices  based  on  physical  considerations  and  an  approximate 
cost  function  that  minimizes  the  control  energy  needed  to  suppress 
vibrations  in  a clamped  structure.  The  tailoring  procedure  is  based  on  the 
open  loop  eigenvalues  and  eigenvectors,  and  a weighting  matrix  is  chosen 
in  a way  that  the  low  frequency  modes  contribute  most  to  the  cost  index. 

Robot  arms  with  integrated  structure  and  control  design  have 
received  attention  since  the  early  1990s  for  a single  link  flexible 
manipulator.  Asada  et  al.  x investigated  the  dynamic  characteristics, 
particularly  pole-zero  location,  in  relation  to  design  parameters,  i.e.,  the 
shape  and  structure  of  the  arm  mechanism.  This  strategy  formulates  the 
inverse  relationship  of  the  pole-zero  plot  back  to  the  arm  structure  using  a 
generalized  Jacobian  method.  Asada  and  coworkers  solved  the  inverse 
problem  of  finding  an  optimal  structure  that  satisfies  the  desired  pole-zero 
specifications  for  a single  link  flexible  arm.  Rai  and  Asada39  applied  this 
concept  to  a flexible  manipulator  by  using  singular  value  decomposition. 
Singular  value  was  interpreted  as  a scale  factor  between  the  vectors  in  the 
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design  variables  space  and  the  vectors  in  the  system  characteristics  space. 
Jacobian  matrix  mapping  between  the  design  space  and  system 
characteristics  space  were  calculated;  the  magnitude  of  the  singular  value 
of  the  Jacobian  matrix  served  as  a criterion  for  the  trade-off  analysis 
between  the  conflicting  properties.  Their  research  is  expanded  with  the 
same  Jacobian  matrix  by  including  the  travel  time  for  a given  task.40  They 
investigated  solutions  to  time-optimal  control  problems  with  respect  to  the 
arm  link  inertia  and  structural  flexibility.  The  single  arm  structure  was 
redesigned  to  minimize  traveling  time  through  trade-off  analysis  between 
arm  inertia  and  its  natural  frequency. 

Very  few  studies  are  published  on  integrated  structure  and  control 
design  of  a two  link  flexible  manipulator.  Park  and  Asada41  introduced  the 
integrated  design  for  high-speed  positioning.  Control  gains  for  the  rigid 
modes  were  designed  first  based  on  maximizing  the  dominant  rigid  mode 
pole  by  changing  the  actuator  location.  The  design  parameters  were  arm 
geometry,  including  length,  width  and  height,  with  system  mass  and  length 
constraints.  The  parameters  were  optimized  to  maximize  the  real  part  of 
the  rigid  mode  dominant  pole  that  represents  the  speed  of  response. 

Objective  of  This  Study 

A literature  review  revealed  that  design  of  a two  link  flexible 
manipulator  remains  a challenging  research  area,  particularly  in  considering 


the  controller  effects. 
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This  study  will  design  a two  link  manipulator  by  using  modal 
parameters.  Consequently,  the  structural  characteristics  of  the  two  link 
manipulator  are  investigated  within  given  design  variable  constraints.  The 
clamped  free  and  clamped  mass  models  are  analyzed  and  compared.  The 
effects  of  general  input  locations  on  modal  stiffness  and  modal  mass  are 
also  investigated. 

After  the  structural  characteristics  are  investigated,  the  optimal 
structural  design  is  performed  based  on  the  modal  parameters.  This  study 
introduces  three  structural  optimization  schemes  that  are  based  on  natural 
frequency,  modal  stiffness,  and  the  product  of  the  modal  mass  and  the 
modal  stiffness,  respectively.  All  of  these  schemes  tend  to  make  a system 
so  massive  that  a conflicting  property,  mass,  is  included  to  find  an  optimal 
structure  within  diametric  constraints. 

After  structural  optimization  is  accomplished,  the  integrated 
structure  and  control  design  of  the  flexible  manipulator  is  undertaken.  The 
structural  design  itself  does  not  guarantee  that  the  designed  manipulator  is 
optimal  when  it  is  included  in  the  control  loop.  A PD  controller  is 
designed  for  the  structurally  optimal  two  link  flexible  manipulator.  A new 
approach  is  introduced  to  include  controller  effects  by  using  rigid  mode 
modal  parameters.  The  design  of  the  final  system  includes  the  effects  of 
the  modal  parameters  of  both  the  rigid  and  the  flexible  modes.  The 
approach  followed  in  this  research,  which  focuses  on  the  integration  of  the 
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structure  and  control  design,  shows  that  better  system  performance  is 
achievable  when  the  controller  is  included  in  the  design  stage. 


CHAPTER  3 
SYSTEM  MODELING 

Introduction 

System  modeling  is  the  first  step  in  machine  design  and  control. 
Inadequate  modeling  can  lower  system  performance.  Overly  accurate 
modeling,  however,  can  result  in  excessive  complexity  that  makes  analysis 
intractable  and  control  extremely  difficult.  The  model  need  not  simulate  all 
physical  characteristics  when  it  is  used  in  the  design  stage.  Only  the 
important  characteristics  should  be  included  in  the  model  and  some 
engineering  judgement  can  be  relied  upon  to  find  an  optimal  system  without 
losing  the  main  features  of  the  system.  Accordingly,  most  researchers  use 
linearized  and  reduced-order  models  in  order  to  simplify  system  analysis 
and  control.  In  this  chapter,  the  complex  system  equations  will  be 
simplified  by  using  linearizing  schemes  in  treating  equivalent  beam  model, 
vibration  modes,  and  boundary  conditions. 

Another  factor  influencing  the  type  and  accuracy  of  the  model  is  the 
control  scheme.  Unmodeled  mechanical  properties  such  as  friction  or 
damping  can  cause  deterioration  in  system  performance  especially  when  an 
open  loop  control  scheme  is  used.  For  example,  the  dynamic  model 
inversion  technique  requires  exact  modeling  because  the  inverse  of  the 
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transfer  function  is  used  to  cancel  unwanted  system  characteristics  without 
considering  disturbances.  The  performance  of  an  LQ-based  controller  is 
more  dependent  on  the  system  model  because  of  sensitivity  to  weighting 
factors.  These  kinds  of  control  schemes  need  exact  modeling  if  controller 
robustness  is  to  be  assured.  When  a robust  control  scheme  is  used  such  as 
PID  type  controller  or  adaptive  controller,  the  system  performance  is  less 
sensitive  to  disturbances  so  that  exact  and  complex  modeling  is  not 
necessary. 

The  modeling  of  flexible  manipulators  has  been  studied  by  many 
researchers  during  the  last  three  decades.  The  design  and  control  of 
flexible  manipulators  have  attracted  attention  since  their  use  in  space 
shuttles.  Many  approaches  have  been  proposed  for  modeling  of  the  flexible 
manipulator  and  can  be  grouped  into  three  categories:  PDE  (partial 
differential  equation),  FEM  (finite  element  method),  and  AMM  (assumed 
mode  method).  Partial  differential  equations42  can  yield  precise 
mathematical  models  but  may  cause  formulational  and  computational 
difficulties  and  consequently  most  application  of  this  method  is  limited  to 
simple  structures.  One  of  the  recent  popular  methods  is  the  finite  element 
methods  that  utilizes  a set  of  linear  ordinary  differential  equations.  This 
method  can  derive  a detailed  mathematical  model  for  the  structure  and 
allow  flexibility  for  modeling  arbitrary  cross  sections  and  arbitrary 
boundary  conditions.  The  complexity  of  this  type  of  modeling  makes 
difficult  its  application  in  a design  stage  that  includes  controller  effects. 
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The  finite  element  model  also  produces  high  frequency  elastic  modes  and 
the  amount  of  computations  can  be  so  extensive  that  the  numerical  solution 
of  the  system  equations  is  difficult.  The  third  approach  is  the  assumed 
mode  method  in  which  partial  differential  equations  are  simplified  through 
transformation  into  ordinary  differential  equations.  This  is  the  most 
commonly  used  modeling  method  for  the  controller  design  of  a manipulator 
because  a relatively  small  number  of  states  can  be  used  to  approximate  a 
distributed  parameter  system.  This  approach  avoids  the  high  frequency 
problems  and  is  implemented  easily  using  computers.  The  limited  modeling 
flexibility  of  this  method  makes  its  application  difficult  for  systems  with 
complex  shapes,  but  it  is  an  attractive  method  for  manipulator  modeling  of 
a generally  simple  structure  and  long  arms.  This  method  is  adopted  in  this 
study  for  modeling  the  flexible  modes  of  the  manipulator  and  including  the 
controller  effects  in  the  design  process. 

There  are  two  types  of  models  for  the  beam:  the  Timoshenko  beam  and 
the  Euler-Bernoulli  beam.  The  Timoshenko  beam  includes  most  of  the 
effects  that  might  take  place,  e g.,  shear,  bending  deformation,  and  rotary 
inertia  effects.  Shear  deformation  is  insignificant  in  the  planar  motion 
robot  and  axial  displacement  is  also  negligible  due  to  insignificant  axial 
forces.  The  bending  deformation  of  the  beam  is  the  only  effective  and 
considerable  deformation  in  this  study.  Accordingly,  the  Euler-Bernoulli 
beam  model  is  adopted  to  determine  the  flexible  modes  of  the  manipulator. 
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The  general  modeling  method  developed  by  Book  et  al.10  is  adopted  for  this 
study. 

This  chapter  presents  the  application  of  the  Euler-Bernoulli  beam 
model  and  the  assumed  mode  method  to  the  flexible  modes  of  the 
manipulator.  The  system  energies,  kinetic  and  potential  energy,  will  be 
derived  to  obtain  the  system  equations  via  the  Lagrange  equation.  The 
resulting  system  is  described  by  6 DOF  nonlinear  equations  with  2 DOF  for 
the  rigid  modes  and  4 DOF  for  the  flexible  modes.  This  nonlinear  system 
model  is  then  simplified  based  on  linearizing  schemes  for  the  design  and 
control  process.  The  system  analyzed  by  the  assumed  mode  method  will  be 
compared  with  that  constructed  by  FEM. 

Model  Description 

The  model  considered  in  this  study  has  two  links  and  incorporates 
rigid  and  flexible  modes  for  each  link.  The  flexibility  of  each  link  is 
expressed  as  an  Euler-Bernoulli  beam  model  in  which  lateral  vibration  is 
the  only  dominant  vibration  characteristic.  The  two  joints  are  assumed  to 
be  frictionless  with  no  backlash.  The  flexibility  of  the  joints  is  also 
assumed  to  be  negligible  compared  to  that  of  the  long  arms.  The  condition 
of  the  joints  and  the  dynamics  of  the  controller  may  change  the  boundary 
conditions  and  dynamics  of  the  mechanical  system.  Consequently,  two 
different  models,  clamped  free  and  clamped  mass,  will  be  considered.  The 
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effects  of  the  gravity  will  not  be  considered  and,  therefore,  the  equivalent 
stiffness  due  to  gravity  is  not  included  in  the  rigid  body  modes. 

The  real  motion  of  the  beam  is  a coupling  of  the  rigid  body  motion  and 
the  elastic  deformation.  To  describe  the  multibody  dynamics  including  the 
flexible  modes,  two  types  of  coordinate  systems  are  used:  the  global  (fixed) 
coordinate  system  and  the  local  (moving)  coordinate  system.  The  rigid 
body  motion  can  be  represented  by  the  coordinate  transformations  between 
two  adjacent  links  and  the  elastic  motion  is  expressed  in  terms  of  the 
deflection  of  each  link  with  respect  to  the  local  coordinate.  A schematic 
diagram  of  the  system  is  shown  in  Figure  3-1. 

The  links  are  considered  to  be  hollow  cylinders  and  the  ratio  between 
the  external  diameter  and  the  thickness  is  fixed  at  0.02.  The  selection  of 
this  ratio  and  the  shape  of  the  cross  section  are  guided  by  consideration  of 
applicability  of  beam  theory  for  plane  sections  to  remain  plane.  The 
diameters  of  the  two  links  will  be  considered  as  the  design  parameters 
influencing  the  cross-sectional  area,  the  stiffness,  and  the  mass  distribution 
of  the  manipulator  system.  The  slopes  at  the  end  of  each  link  are  included 
by  using  the  assumed  mode  method  in  which  these  are  the  first  partial 
derivative  of  the  link  deflection.  The  end  effector  is  represented  by  a 
payload  which  has  mass  and  rotational  inertia. 

Referring  to  Figure  3-1,  the  axes  of  coordinates  are  described  with 
the  notation  of  [x,yj  and  the  subscript  ‘ i ’ is  0 for  the  fixed  coordinate 
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Figure  3-1  Schematic  diagram  of  the  arm 
(a)  Coordinate  systems 
(b)  Nomenclature  of  the  elastic  arm  model 
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and  1,  2 for  the  moving  coordinates  on  the  first  and  second  links 
respectively.  The  unit  vectors  on  the  frame [Xj^]  are  defined  as 

ux, 

(3-1) 

KJ 

and  the  deflections  on  each  link  are  ui  and  u2  respectively.  The  subscript 
‘E’  will  be  used  to  represent  the  end  of  the  link;  i.e.,  uiE  represents  the 
deflection  at  the  end  of  the  first  link.  A position  on  the  flexible  link  can  be 
expressed  by  the  summation  of  two  perpendicular  position  vectors  as 


(3-2) 


The  slope  at  the  end  of  each  link  is  defined  as 


(3-3) 


and  transformation  matrix  and  angular  velocity  matrix  are 


[TR  cos*;  -sin*; 
sin#  cos# 


(3-4) 


(3-5) 


where  0\  = #,  and  <9*  = <9,  + 02  + u[E . 


By  using  the  above  notations,  the  position  vectors  of  any  point  in  beams  1 
and  2 are  represented  as  follows 
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The  velocity  vectors  can  be  obtained  by  differentiating  the  position  vectors 
with  respect  to  time  and  expressed  as 

vi  = [tr,  ] [n;  ](x,  + u, ) + [TR,  ](  u, ) 

Y,  - VIE+  [TR2][n;](xI+  u2)+[TR2](u2).  <3‘7) 

These  vector  notations,  which  are  similar  to  those  used  by  Meirovitch  and 
Chen,44  will  be  used  to  calculate  the  kinetic  and  the  potential  energy  of  the 
Lagrange  equation  and  to  formulate  the  system  equations  of  the  two  link 
manipulator. 


Assumed  Mode  Method 

This  section  presents  the  assumed  mode  method  and  how  to  derive 
mode  shapes  for  the  flexible  modes.  The  governing  equation  for  the 
deflection  of  the  beam  is  the  Euler-Bernoulli  equation  which  can  be  written 
as 


^u4(x,t)  i _ ^u2(x,t) 
d x4 


El — — Y7  7 + m = 0 


(3-8) 


where  m is  the  mass  per  unit  length,  El  is  the  flexural  rigidity.  The 
deflection  is  a function  of  position  and  time  as  shown  in  the  fourth  order 


partial  differential  equation.  Direct  use  of  the  PDE  is  difficult  to  solve  for 
the  deflection.  Consequently,  a simpler  procedure  is  considered,  the  so 
called  separation  of  variables.  This  method  leads  to  convenient 
expressions  of  the  deflection  by  changing  the  partial  deferential  equations 
into  ordinary  differential  equations  to  derive  the  generalized  mass  and 
stiffness.  Accordingly,  the  deflection  can  be  expressed  by  a linear 
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combination  of  admissible  function  </>(x)  multiplied  by  time  dependent 
general  coordinate  q(t)  as 


u(x,t)  = ^(x)q(t).  (3-9) 

The  admissible  functions  are  arbitrary  functions  that  satisfy  the  geometric 
boundary  conditions  and  need  not  satisfy  all  natural  boundary  conditions. 

By  substituting  equation  (3-9)  into  equation  (3-8),  the  original 
equation  is  divided  into  two  ordinary  differential  equations  as 


dV(x) 

dx4 


-/?>(x)  = 0 


d2q(0 

dt2 


+ <y2q(t)  = 0 


(3-10) 


where  /?4-m<y'/EI,  and  co  is  the  vibration  frequency  of  the  beam.  The 
solution  of  the  first  equation  is  the  mode  shape  of  the  beam  and  that  of  the 
second  equation  is  the  time  dependent  harmonic  response  with  a certain 
frequency. 

When  the  mode  shapes  are  calculated,  boundary  condition  problems  are 
encountered.  Most  researchers  use  a clamped  free  beam  model  for  the 
single  link  flexible  manipulator  wherein  it  is  straightforward  to  calculate 
the  modes.  The  adoption  of  the  clamped  free  beam  model  implies  zero 
slopes  for  the  deflections  at  the  joints.  When  a multilink  manipulator  is 
modeled,  each  link  is  considered  to  be  an  independent  beam  clamped  at  one 
end.  Using  the  clamped  modes  as  the  expansion  function  is  an 
approximation,  and  the  exact  mode  is  not  defined.  The  reasons  are  that, 
first,  the  mode  shape  depends  on  the  angle  of  the  joints;  second,  the  elastic 
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deformation  at  the  end  of  the  previous  link  contributes  the  angle  of  the 
next  link;  third,  the  controller  also  effects  the  dynamics  of  the  joints.  The 
system  dynamics  of  the  multilink  manipulator  are  nonlinear  and  are 
dependent  on  configuration  and  controller.  This  study  adopts  both 
clamped  free  and  clamped  mass  models  for  the  two  link  manipulator  as  an 
approximation,  although  they  do  not  accurately  represent  the  real  physical 
modes  of  the  system. 

The  boundary  conditions  are  divided  into  two  categories,  the 
geometric  and  the  natural  boundary  conditions.  The  geometric  boundary 
conditions  are  the  deflection  and  the  slope  at  the  clamped  side  and  can  be 
written  as 


The  natural  boundary  conditions  are  the  moments  and  the  shear  forces  at 
the  end  of  the  links.  The  shear  force  is  used  to  distinguish  the  clamped 
free  mode  and  the  clamped  mass  mode  because  the  clamped  free  mode  has 
no  shear  forces  at  the  end  of  the  link.  The  natural  boundary  conditions  for 
the  clamped  mass  mode  are 


u(0, t)  — 0 and  — (Q,t)  = 0 . 


dx 


(3-11) 


gi^-UCM)  = 0 

A „2 


d x 


& u(L,t) 


(3-12) 
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By  substituting  the  boundary  conditions  into  the  solution  of  equation 
(3-10)  and  equating  the  determinant  of  the  coefficient  matrix  to  zero,  the 
frequency  equation  for  the  clamped  mass  mode  can  be  derived  as 


1 + cos(ArL)  x cosh(ArL) 


’’ayl°ad  x ^rL  x (cos(ArL)  x sinh(ArL)  - sin(ArL)cosh(ArL))  = 0 

^Mink 


(3-13) 


where  r is  the  number  of  the  vibration  mode  and  XrL  are  the  roots  of  the 
frequency  equation.  This  equation  is  used  to  calculate  the  natural 
frequencies  of  the  beam  and  larger  payloads  would  lower  the  natural 
frequency  of  the  beam.  The  third  term  of  the  left  side  of  the  equation  is 
zero  for  the  clamped  free  mode  due  to  the  no  payload  effect.  Using  four 


boundary  conditions  and  the  solution  of  frequency  equations,  the  resulting 
mode  shape  of  the  single  link  can  be  expressed  as 

MX)  - (coshd.x)  - «■«,*))-  ggg±gJM(sinh(Arx)  - sin(Arx))  (3- 14) 


As  we  can  see  from  equation  (3-14),  there  are  theoretically  an  infinite 
number  of  solutions  for  the  frequency  equations.  In  practice,  it  is  not 
necessary  to  include  all  vibration  modes  to  simulate  all  system 
characteristics.  Since  the  response  contributions  of  the  higher  modes  of 
the  flexible  links  decay  fast  and  the  amplitude  of  these  modes  are  generally 
small,  the  deflection  is  dominated  by  the  low  frequency  modes.  Most 
researchers  who  use  the  constraint  mode  analysis  include  system  vibration 
modes  1 or  2.  In  this  study  the  number  of  the  significant  modes  was 
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chosen  to  be  two  for  each  link.  This  should  be  enough  to  represent  the 
main  characteristics  of  the  system  for  the  design  of  the  manipulator. 

The  deflections  are  replaced  by  product  of  mode  shapes  and 
coordinates  based  on  the  assumed  mode  method.  Two  modes  of  vibration 
are  added  for  total  deflection  and  the  resulting  deflections  can  be  expressed 
as 

Ui  (x, , t)  = </>u  (x,  )q„  (t)  + </>n  (x,  )q  12  (t) 

u2  (x2 , t)  = <j>2X  (x2)q21  (t)  + <j>22  (x2)q22  (t)  (3'15) 

where  4>n,  <t>i2,  <t>2i  and  (j>22  are  the  mode  shape  functions  and  qn,  q j 2,  q2i, 
and  q22  are  the  generalized  coordinates.  The  first  number  of  the  subscript 
represents  the  number  of  the  link  and  the  second  the  number  of  the 
vibration  mode.  The  deflections  in  equation  (3-15)  will  be  used  to 
calculate  the  kinetic  and  potential  energies  of  the  system  in  terms  of  the 
generalized  coordinates. 


Kinetic  Energy 

The  kinetic  energy  is  derived  here  to  obtain  the  system  equations  by 
using  the  Lagrange  method.  The  kinetic  energy  of  the  two  link  flexible 
manipulator  is  the  summation  of  the  kinetic  energy  of  each  component  as 

i=l  1 = 1 


(3-16) 
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where  Th,  TL,  and  Tp  are  the  kinetic  energies  of  the  hub,  link,  and  payload 
respectively.  Each  component  of  the  system  kinetic  energy  can  be 
expressed  as  below 


1 2 . 2 i 

Th,=rZJh,^  +-mh2V1E-V1E 


i-1 


* 1 vnij  ) 

= Tmp^2E  ' YjE  +TJp(^2  +1^2e) 


(3-17) 


The  kinetic  energies  are  expressed  in  terms  of  velocity  and  mass.  The 
velocities  are  composed  of,  first,  the  linear  and  angular  components, 
second,  the  rigid  and  flexible  mode  components.  The  angular  velocity 
includes  the  slope  due  to  deflection  at  the  end  of  the  link. 


Potential  Energy  and  Virtual  Work 

The  potential  energy  is  due  to  the  strain  energy  of  the  beam  stored 
when  it  is  bent.  The  gravitational  effects  on  energy  are  not  considered  in 
the  planar  motion.  The  potential  energies  of  each  link  are  calculated 
separately  to  obtain  the  potential  energy  of  the  whole  system.  The 
potential  energy  for  two  mode  shapes,  clamped  free  and  clamped  mass,  are 
calculated  separately  in  numerical  simulations.  The  deflection  of  beams  is 
replaced  by  the  admissible  function  multiplied  by  the  general  coordinates 
based  on  the  assumed  mode  method.  The  potential  energy  of  the  two  link 
manipulator  can  be  expressed  as 
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(3-18) 


where  E is  the  modulus  of  elasticity  and  I is  the  moment  of  the  cross 
sectional  area  of  each  link.  The  final  expressions  for  the  kinetic  and 
potential  energy  are  given  in  Appendix  A and  will  be  transformed  into  the 
mass  and  stiffness  matrix  of  the  system  by  the  Lagrange  method. 

As  seen  in  equation  (3-18),  the  potential  energy  of  the  manipulator 
depends  on  the  length  of  the  link,  shape  of  the  cross  sectional  area, 
material  property  of  the  beam,  and  payload  from  the  structural  viewpoint. 
The  potential  energy  also  depends  on  the  acceleration  of  the  beam, 
frequency  components  of  input,  and  frequency  characteristics  of  the 
controller  from  the  control  viewpoint. 

Virtual  work,  which  is  the  work  done  by  all  the  outside  forces  in  a 
virtual  displacement,  is  used  to  obtain  the  external  forces  of  the  system  in 
the  Lagrange  equation.  For  the  manipulator,  virtual  work  is  defined  by 
both  torque  in  virtual  angular  displacements  at  the  joints  and  disturbance 
force  in  virtual  linear  deflections  at  the  end  of  each  link.  The  form  of 
virtual  work  can  be  expressed  as 


VW  = £(T,x(S0*  + F1x<5u,E). 


i=l 


(3-19) 


This  equation  implies  that  the  virtual  work  has  components  of  both  the 
rigid  and  the  flexible  mode  motions.  The  angular  displacement  due  to  the 
slope  at  the  end  of  the  previous  beam  is  considered  at  the  joints  and  the 
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linear  deflection  at  the  end  of  each  link  is  also  included  in  the  flexible 
modes. 

Damping 

Damping  can  be  categorized  in  two  ways:  viscous  damping  for  the 
rigid  mode  and  structural  damping  for  the  flexible  mode.  In  the  rigid  body 
mode,  damping  is  necessary  to  increase  the  stability  of  the  system. 
However,  it  is  not  always  practical  to  increase  the  damping  structurally. 
One  practical  way  is  the  use  of  the  control  concept.  When  velocity 
feedback  is  used,  the  effect  of  the  viscous  damping  is  not  significant 
compared  to  the  damping  effect  of  the  velocity  feedback.  This  is  one 
reason  why  an  exact  model  of  the  system  is  not  necessary  in  the  design 
stage.  The  system  used  here  will  utilize  velocity  feedback  control  and 
viscous  damping  will  not  be  included  in  the  analysis. 

In  the  flexible  mode,  however,  structural  damping  is  included  It  is 
not  easy  to  determine  the  structural  damping  theoretically.  Many 
researchers  use  the  proportional  damping  in  which  damping  is  proportional 
to  the  linear  summation  of  the  mass  and  stiffness,  even  though  it  is  not 
applicable  for  all  structural  vibration  problems.  A more  convenient  way  to 
evaluate  the  structural  damping  is  the  modal  analysis  in  conjunction  with 
experiments.  Most  machine  members  such  as  robot  arms  have  damping 
ratios  around  1-4  percent.  This  study  assumes  the  structural  damping  ratio 
as  1 percent  for  both  the  first  and  second  modes  of  the  link. 
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Structural  damping  coefficients  for  the  clamped  beam  model  can  be 
written  as 

(3-20) 

®n,j 

where  C,  is  the  damping  ratio,  con  is  natural  frequency,  keff  is  the  effective 
stiffness  for  a certain  vibration  mode,  and  the  subscript  ij  represents  i-th 
link  and  j-th  mode. 

In  order  to  include  damping  in  the  Lagrange  equation,  the  Rayleigh 
dissipation  function  3 is  used  as 

inn 

3 = rZZc,M  (3-21) 

Z i=l  j=l 

where  n is  the  number  of  the  generalized  coordinates  and  q is  the  time 
derivative  of  the  generalized  coordinates.  The  velocity  feedback  will  be 
used  to  determine  the  damped  rigid  mode  response  and  the  structural 
damping  is  to  evaluate  the  flexible  beam  responses  in  time  domain 
simulation. 


System  Equation 

After  expanding  the  vector  notation  energies  derived  in  the  previous 
sections,  the  Lagrange  equation  uses  scalar  quantities  of  kinetic  energy  and 
potential  energy  to  derive  system  equations.  Its  general  form  can  be 
expressed  as 
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d f dKE' 
dtWqn> 


dKE  + dm  dZ 

d(\n  ^qn  <?qn 


(n  - 1,  2 ...6) 


(3-22) 


where  the  quantity  Qn  is  the  generalized  force  corresponding  to  the  selected 
generalized  coordinates  qn,  {<?,,  02,  q„,  q12,  q21,  q22}T  respectively.  The 

generalized  coordinates  qn  show  2 rigid  mode  variables  and  4 flexible  mode 
variables  so  that  the  system  has  6 DOF. 

By  substituting  the  derived  scalar  kinetic,  potential  and  damping 

energy  into  the  Lagrange  equation,  the  resulting  dynamic  equation  of 

motion  can  be  expressed  in  the  matrix  form 

[NM]{q}  +[C]{q}  +[K]{q}  + {NF}  = [TC]{T}  (3-23) 

where 


[NM]  : nonlinear  mass  matrix  (6x6) 

[C]  : damping  matrix  (6x6) 

[K]  : stiffness  matrix  (6x6) 

{NF}  : nonlinear  force  (6x1) 

[TC]  : torque  coefficient  matrix  (6x4) 

{T}  : external  input  (4  x 1),  {T„  T2,  F„  F2}' 

Equation  (3-23)  includes  nonlinear  terms  in  the  mass  matrix  and  the 
force  vector.  These  nonlinearities  complicate  the  design  and  control 
schemes  and  a linearized  model  will  be  derived  for  simplicity.  The  higher- 
order  terms,  such  as  coordinate  coupling  terms  of  the  elastic  motion,  are 
neglected.  The  sines  and  cosines  are  replaced  by  the  first  terms  of  its 
Taylor  series  representation  with  a small  angle  assumption.  The  resulting 
linearized  equation  of  motion  is  time-invariant  and  can  be  expressed  as 


[M]{q}+[C]{q}+[K]{q}  = [TC]{T}. 
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(3-24) 


The  elements  of  the  matrices  in  equation  (3-24)  can  be  written  as 


[M]  = 


Mrr 


M 

M 


rf 

ff 


diag([C])  = { 0,  0,  Cu,  C12,  C21,  C22} 
diag([K])  = { 0,  0,  K„,  K12,  K21,  K22} 


(3-25) 


where  the  subscript  ‘rr’  in  the  mass  matrix  means  the  rigid  mode  elements, 
‘ff’  the  flexible  mode  elements,  and  ‘rf’  the  coupling  elements  of  the  rigid 
and  the  flexible  mode.  The  main  components  of  the  mass  matrix  can  be 
expressed  as 


Mrr  J h + J Link  + ^ payload  + M payload L 

Mrf  - mL2  J ^(x)xdx  + M ]oad^E  +Jpayload^' 

r (3-26) 

diag(Mrr)  = J m^(x)2  dx  + Mpayload^  +Jpayload^'2 

off -diag(Mff)  - M payload<ME  + Jpayload^' 

This  mass  matrix  is  symmetric  and  should  be  positive-definite  to  represent 
a physically  realizable  system.45  A necessary  and  sufficient  condition  for  a 
matrix  to  be  positive-definite  is  that  all  determinants  obtained  from  a 
matrix  should  be  positive.  The  elements  of  the  stiffness  matrix  can  be 
expressed  as 


K'>  = EIX(<Mx))’dx  (3-27) 

The  integration  involving  the  mode  shape  functions  are  calculated  by 
numerical  method.  The  details  of  the  components  of  the  matrices  [M],  [C], 
[K]  and  [TC]  are  provided  in  Appendix  B 
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In  order  to  include  equation  (3-24)  in  the  control  loop,  it  is 
convenient  to  use  the  state  space  form  and  the  resulting  equation  can  be 
written  as 

{X}  = [A]{X}  + [B]{T}  (3-28) 

where 


{X}  12  * ! = {{q}  (q}}T 


(3-29) 


[A]l2 


0 I 

-[M]'[K]  — [M]'*[C] 


(3-30) 


[B]  12  x 4 ~ 


0 

[M]  '[TC]  ’ 


(3-31) 


Model  Comparison  with  FEM 

The  system  model  derived  by  the  assumed  mode  method  is  compared 
to  that  obtained  from  the  finite  element  method  in  this  section.  In  general 
any  assumed  model  should  be  verified  with  a different  model  or  experiment 
to  check  the  reliability  of  the  modeling  method.  A finite  element  analysis 
program  is  used  to  check  the  validity  of  the  derived  model  based  on  the 
assumed  mode  method. 

One  computer  program  available  for  the  analysis  of  machine 
structure  is  COSMOS/M,  finite  element  analysis  software  from  Structural 
Research  & Analysis  Corp.  COSMOS/M  is  a modular  software  package  for 
design,  analysis,  and  optimization,  in  which  there  are  linear  statics, 

dynamics,  nonlinear,  thermal,  fluid,  electromagnetic,  and  design 
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optimization  modules.  The  module  for  linear  dynamic  analysis  is  used  to 
evaluate  the  natural  frequencies  and  corresponding  mode  shapes  of  the 
flexible  manipulator  system. 

One  example  system  was  chosen  for  comparison,  where  the  structural 
material  is  assumed  to  be  same  as  that  used  in  the  flexible  manipulator  of 
the  space  shuttle.18  The  lengths  of  the  each  link  are  assumed  to  be  7 m and 
the  modulus  of  the  elasticity  is  1 4 . 5 e 1 0 N/mA2.  The  density  is  assumed  to 
be  1744  kgm/mA3.  The  outer  diameter  of  the  first  link  is  0.19  m and  that 
of  the  second  link  is  0.15  m.  The  thickness  is  assumed  to  be  2 percent  of 
the  outer  diameter  of  each  link.  The  end  effector  or  payload  at  the  end  of 
the  link  is  assumed  to  be  100  Kgm  and  the  mass  of  the  second  joint  is  50 
Kgm. 

The  two  link  manipulator  is  modeled  by  beam  elements  and  mass 
elements  in  the  FEM.  The  beam  element  is  for  a continuous  mass  model 
such  as  links  and  the  mass  element  is  for  joint  mass  or  end  effector.  All 
joints  are  assumed  locked  so  that  the  rigid  mode  of  beam  is  eliminated  for 
the  finite  element  analysis.  The  model  in  the  FEM  is  clamped  at  the  joints 
and  the  entire  system  is  vibrating  as  a clamped  free  beam  model.  Each  link 
is  meshed  into  10  elements  of  beam  model.  The  program  code  for 
COSMOS/M  appears  in  Appendix  C. 

The  model  in  the  assumed  mode  method  uses  only  Mff  and  Kff  to 
evaluate  the  flexible  mode  natural  frequencies.  The  whole  system  is 
composed  of  two  links  and  can  be  modeled  as  the  summation  of  the  two 
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clamped  free  beam  models.  Using  only  the  flexible  mode  implies  that  the 
interactions  between  the  rigid  and  flexible  modes  are  not  encountered  as  in 
the  finite  element  analysis.  Two  vibration  modes  for  each  link  means  four 
vibration  modes  of  the  whole  system  in  the  assumed  mode  method  and 
consequently,  four  flexible  modes  are  calculated  in  the  FEM  for 
comparison.  The  results  are  shown  in  Table  3-1.  The  first  two  vibration 
modes  from  the  AMM  are  about  4 percent  different  than  the  results  from 
the  FEM  and  the  higher  modes  show  bigger  differences.  The  first  vibration 
mode  is  the  most  important  characteristic  in  the  flexible  mode  so  that  only 
this  mode  of  the  beam  will  be  used  in  the  design  stage.  Figure  3-2  shows 
the  first  two  mode  shapes  of  the  whole  system  from  the  finite  element 
method. 

Table  3-1  Frequency  comparison  of  two  methods  and  unit  (Hz) 


Mode 

AMM 

FEM 

% difference 

1 

0.557 

0.537 

3.5 

2 

3.574 

3.417 

4.4 

3 

13.234 

9.024 

30.8 

4 

34.642 

28.214 

18.6 
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mode  1 


Figure  3-2  Mode  shapes  of  the  system  from  FEM 
(Mode  1:  0.54  Hz  and  Mode  2:  3.4  Hz) 


CHAPTER  4 

STRUCTURAL  OPTIMIZATION 
Introduction 

The  optimization  of  a mechanical  structure  is  an  important  step  in 
the  design  process  because  there  are  many  possible  design  results  which 
satisfy  the  system’s  functional  requirements  within  its  design  constraints. 
Some  design  variables  may  show  contradicting  effects  which  deteriorate 
one  performance  by  increasing  another.  Optimization  of  a system  is  to  find 
a structure  that  best  satisfies  the  functional  goal  of  the  system  within  its 
design  constraints. 

For  the  manipulator  system,  there  are  two  important  characteristics 
which  are  the  rigid  and  the  flexible  modes.  The  rigid  mode  characteristics 
include  the  dynamic  parameters  of  the  manipulator,  such  as  velocity  or 
acceleration,  that  depend  on  mass  or  inertia.  The  flexible  mode 
characteristics  are  the  deflection  and  vibration  that  affect  the  position 
accuracy  and  the  speed  limit  of  the  manipulator.  These  two  performance 
characteristics  conflict  with  each  other  and  the  optimal  point  is  a 
compromise  between  the  two.  Industrial  robots  focus  on  position  accuracy 
by  minimizing  deflection  and  are,  consequently,  massive  with  poor  rigid 
mode  dynamics.  Space  manipulators  have  weight  constraints  and  are, 
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generally,  long  and  flexible  with  a large  payload.  Depending  on  the 
application  of  robots,  the  objective  function  should  be  appropriately  chosen 
in  the  optimization  scheme. 

One  of  the  common  property  used  in  objective  functions  is  the 
eigenvalue,  which  is  the  natural  frequency  of  the  vibration  and  the  pole  in 
the  control.  This  study  includes  this  property  for  the  optimal  manipulator 
design.  This  chapter  also  considers  optimization  schemes  based  on  the 
modal  stiffness  and  impulse  response.  The  natural  frequency  or  modal 
stiffness  should  be  chosen  as  high  as  possible  to  minimize  deflection  in  the 
design  of  the  machine  structure  but  would  result  in  a massive  system  with 
poor  rigid  mode  dynamics.  Therefore,  a conflicting  property  such  as 
weight  minimization  is  included  in  the  objective  function  to  compensate  for 
the  adverse  performance  of  a high  frequency  system. 

This  chapter  is  organized  as  follows.  First,  the  structural 
characteristics  of  the  manipulator  are  investigated.  Second,  mechanical 
optimization  of  the  system  is  performed  based  on  three  performance 
characteristics,  natural  frequency,  modal  stiffness,  and  impulse  response 
with  the  clamped  free  model.  Clamped  mass  model  is  also  optimized  by 
using  the  natural  frequency.  The  effects  of  the  system  parameters  and  the 
results  of  optimization  schemes  are  discussed. 


Structural  Characteristics 
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The  two  link  manipulator  has  two  modes,  the  rigid  and  flexible  body 
modes.  Both  modes  have  different  effects  so  that  this  study  investigates 
the  system  characteristics  for  both  modes  to  find  an  optimal  system.  To 
improve  the  rigid  mode  performance,  minimization  of  mass  or  inertia  can  be 
considered.  In  this  study,  minimization  of  mass  will  be  used  as  the 
objective  function  to  focus  on  light-weight  characteristics  of  a space 
manipulator.  For  the  flexible  body  mode,  the  structural  characteristics  of 
manipulators  will  be  analyzed  including  the  modal  mass,  modal  stiffness 
and  natural  frequencies  of  the  two  link  manipulator.  Structural  damping 
enhancement  is  one  of  the  significant  factors  that  can  be  used  to  reduce 
vibration  but  is  beyond  the  scope  of  this  study. 

Mass 

A system  with  large  mass  and  inertia  requires  high-torque  motors 
and  consumes  more  energy  to  execute  a motion  and  consequently  a light- 
weight manipulator  has  benefits  especially  in  space  applications.  There  are 
popular  light  structural  materials,  such  as  magnesium,  aluminum,  and 
titanium,  but  the  carbon  composite  material1*  used  in  space  manipulators  is 
chosen  for  this  study  as  described  in  the  last  section  of  Chapter  3.  The 
external  diameter  of  the  link  is  limited  in  order  to  reduce  waste  of  the 
usable  space  in  the  space  shuttle.  This  study  assumes  that  the  external 
diameter  is  constrainted  to  be  within  30cm.  The  ratio  of  the  thickness  to 


42 


the  external  diameter  is  selected  as  0.02  and  it  is  assumed  that  no  buckling 
occurs  due  to  the  negligible  axial  force.  In  reference,  the  space  shuttle 
manipulator  has  less  than  1 percent  of  this  ratio  but  has  stiffening  rings 
inside  of  the  links. 

The  objective  is  to  reduce  the  mass  and  the  objective  function  can  be 
defined  in  normalized  form  as 

U = norm(M)  (4-1) 

where  M is  the  mass  of  the  two  link  manipulator  and  “norm”  defines 
normalization  of  scalar  values  with  the  maximum  value  of  its  components. 
Figure  4-1  shows  a contour  plot  of  the  objective  function,  Equation  (4-1). 
As  expected,  the  objective  function  values  increase  as  the  diameters  of  the 
links  increase.  The  goal  is  to  minimize  the  mass  so  that  the  minimum 
diameters  for  both  links  are  the  best  selection  for  this  objective  function. 

mass  of  system  [Kg] 


Figure  4-1  Contour  plot  of  objective  function  for  mass 
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Natural  Frequency 

Natural  frequencies  play  important  roles  in  the  structural  dynamics 
of  a system.  The  dominant  natural  frequency  of  a mechanical  structure 
should  have  the  highest  feasible  value  in  order  to  reduce  the  transient 
response  time  and  transient  maximum  vibration  and  to  provide  faster 
amplitude  decay  for  a given  damping  characteristic.  High  natural 
frequency  of  a machine  structure  also  yields  high  controller  gain  so  that  a 
wide  bandwidth  of  controlled  motion  exists. 

The  natural  frequencies  can  be  calculated  as 

fn  = —-^eigenvalue  of  [M]  ‘[K]  (4-2) 

2k 

where  unit  of  fn  is  Hz  and  [M]  ’[K]  is  the  dynamic  matrix.  In  calculation  of 
the  natural  frequency,  two  cases  can  be  considered  based  on  conditions  of 
joints.  In  the  first  case,  the  joints  are  locked  with  the  whole  system 
assumed  to  vibrate  as  a cantilever  beam  as  in  the  FEM  model  in  Chapter  3. 
The  dynamic  matrix  uses  only  the  flexible  mode  segments  of  the  mass  and 
stiffness  matrices.  In  the  second  case,  the  joints  are  unlocked  with  the 
whole  system  as  a combination  of  two  cantilever  beams.  The  dynamic 
matrix  uses  the  rigid  and  flexible  mode  segments  of  the  mass  and  stiffness 
matrices.  The  result  will  show  four  vibration  modes  in  both  cases  and  the 
joint-free  case  will  show  higher  frequencies  due  to  the  pinned  condition  of 
the  rigid  mode  at  the  joints. 
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The  high  number  of  vibration  modes,  generally,  produces  more 
accurate  results  for  the  simulation  of  the  system  characteristics.  For  the 
control  application,  the  number  of  the  vibration  modes  depends  on  the  cut- 
off frequency  of  the  controller.  The  exciting  frequencies  of  external  forces 
or  disturbances  also  will  influence  the  number  of  vibration  modes  to  be 
considered  in  the  design  process.  In  this  study,  the  first  mode  of  vibration 
is  considered  to  include  the  flexible  mode  in  the  design  stage  and  four 
vibration  modes  are  used  in  the  time  domain  simulation  of  the  response. 

The  dominant  frequencies  for  both  cases  with  the  clamped  free  model 
are  shown  in  Figure  4-2.  The  first  mode  of  vibration  shows  very  low 
frequencies  (less  than  1 Hz)  for  the  joints-locked  case.  The  dotted  line 
represents  the  optimal  line  which  has  the  highest  frequency  with  minimum 
mass.  The  corresponding  equation  of  this  optimal  structure  is 
Dl  = 1.45*D2-0.006  and  the  diameter  of  the  first  link  is  about  30  percent 
larger  than  that  of  the  second  link  with  joint-locked  condition.  Figure  4-2 
(b)  shows  the  natural  frequencies  with  the  joints-unlocked  condition  and 
the  system  shows  much  higher  frequencies  due  to  the  pinned  conditions  at 
the  first  and  second  joints.  The  dotted  line  is  the  optimal  line  that  provides 
the  highest  natural  frequency  with  the  lowest  mass  when  the  joints  are  free. 
The  relation  between  the  two  diameters  can  be  expressed  as  Dl=  1.14*D2- 
0.08  which  implies  that  the  diameter  of  the  second  link  should  be  larger 
than  that  of  the  first  link.  This  is  due  to  the  payload  at  the  end  of  the 
second  link  and  to  the  clamped  free  conditions.  The  larger  the  payload  the 
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Figure  4-2  System  natural  frequencies  with  clamped  free  model 
(a)  fn  with  joints-locked;  (b)  fn  with  joints-unlocked 
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larger  the  second  link  and  a smaller  payload  will  shift  the  optimal  line 
upwards  and,  consequently,  decrease  the  diameter  of  the  second  link.  It 
can  be  noticed  that  increasing  the  diameters  of  both  links  increases  the 
natural  frequencies  in  both  the  joint-free  and  joint-locked  conditions  and 
also  decreases  the  settling  time  of  the  response. 

The  mode  shape  then  is  changed  to  the  clamped  mass  model  and  the 
natural  frequencies  are  investigated.  The  results  are  plotted  in  Figure  4-3, 
and  the  natural  frequencies  in  plot  (a)  for  the  joint-locked  case  show  close 
values  to  those  of  the  clamped  free  model  in  Figure  4-2  (a).  When  the 
joints  are  unlocked,  the  natural  frequencies  show  much  lower  values  when 
compared  to  the  clamped  free  cases  in  Figure  4-2  (b).  The  two  results 
show  different  values  and  the  real  value  depends  on  the  joint  conditions. 
Figure  4-3  shows  that  the  optimal  line  is  D 1 = 1 ,45*D2-0.006  for  the  joints- 
locked  cases  and  D 1 = 1 ,26*D2-0.02  for  the  joint-free  cases. 

Modal  Stiffness  and  Modal  Mass 

Stiffness  is  one  of  the  most  important  criteria  for  manipulator  design 
due  to  its  direct  effect  on  position  accuracy.  Low  stiffness  results  in  large 
deflection  of  the  link  and  longer  settling  times  so  that  increasing  stiffness 
is  chosen  as  one  of  the  objectives.  The  problem  of  stiffness  enhancement 
is  especially  important  where  conventional  techniques,  such  as  increasing 
the  size  (which  increases  the  mass)  for  higher  stiffness,  are  unacceptable 
as  in  the  case  of  space  manipulators.  The  stiffness  depends  on  material 
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(a)  fn_f_min  [Hz] 


Figure  4-3  System  natural  frequencies  with  clamped  mass  model 
(a)  fn  with  joints-locked;  (b)  fn  with  joints-unlocked 


48 


property,  length,  and  cross  sectional  area  of  the  link  so  that  one  of  them 
can  be  chosen  to  improve  stiffness.  The  length  depends  on  the  work 
environment  and  the  space  manipulator  usually  has  a long  arm.  The  cross- 
sectional  area  is  the  only  variable  that  affects  stiffness  in  this  study. 

Modal  stiffness  can  be  calculated  as  follows: 

(a)  Calculate  modal  matrix  [P]  with  [M]  and  [K] 

(b)  Rearrange  the  columns  of  [P]  in  the  order  of  ascending  natural 
frequencies 

(c)  Normalize  modal  matrix  by  the  first  element  of  each  column  of  [P] 

(d)  Calculate  the  modal  stiffness  matrix  [Kq]=[P] 1 [K] [P] 

The  modal  stiffness  of  the  structure  is  not  constant  and  depends  on  the 
position  of  the  input  torque.  Normalization  by  the  first  element  of  a 
column  in  (c)  is  valid  when  the  input  torque  is  on  the  first  joint.  When  the 
input  torque  is  on  the  second  joint,  normalization  should  be  performed  by 
using  the  second  element  of  each  column  of  the  modal  matrix.  If  the  input 
is  a disturbance  at  the  end  of  the  links,  then  normalization  should  be  done 
by  using  the  corresponding  elements.  It  should  be  noticed  that  the  physical 
meaning  of  the  value  of  the  modal  stiffness  depends  on  the  units  of  that 
stiffness.  The  modal  stiffness  is  calculated  by  using  the  modal  matrix  and 
the  unit  of  modal  coordinates  are  mixed  with  different  units  of  generalized 
coordinates  so  that  it  is  difficult  to  determine  the  exact  physical  meaning  of 
the  numerical  value  for  modal  stiffness. 
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Four  modal  stiffness  values  for  the  first  vibration  mode  are 
calculated  with  the  joint  free  model  and  plotted  in  Figures  4-4  and  4-5. 
Figure  4-4  shows  the  modal  stiffness  with  two  joint  inputs,  T1  and  T2,  so 
that  these  two  cases  are  based  on  the  joint-unlocked  condition.  The  two 
inputs  show  different  optimal  lines,  which  are  expressed  as  D 1=2.5934*D2- 
0.149  for  the  T1  input  and  Dl-1.0839*D2-0.0643  for  the  T2  input.  The 
plots  show  expected  results,  namely,  that  the  link  with  an  input  torque 
should  be  bigger  than  the  other.  Figure  4-5  shows  the  modal  stiffness  with 
disturbances  at  the  end  of  the  links  with  joint-locked  condition.  It  should 
be  noticed  that  these  results  are  based  on  the  disturbances  for  the  first 
vibration  mode  of  each  link  which  is  different  than  disturbances  on  the 
whole  system.  The  resulting  plot  with  these  disturbances  did  not  show  any 
optimal  lines  but  implies  that  the  link  with  disturbances  should  have  a 
larger  diameter. 

Modal  mass  with  the  clamped  free  model  can  be  calculated  in  the 
same  manner  used  in  calculating  the  modal  stiffness.  The  modal  mass  with 
torque  inputs  on  the  joints  is  calculated  and  the  results  are  plotted  in 
Figure  4-6.  These  results  will  be  used  to  find  the  optimal  mechanical 
structure  in  the  next  section. 

Structural  Optimization  of  Linkages 

The  selection  of  diameters  for  the  optimum  structure  can  be 
accomplished  by  solving  the  minimization  problem  for  the  selected 


(a)  modal  stiffness  w/TI 


Figure  4-4  Modal  stiffness  with  joint  input 
(a)  Torque  at  the  first  joint 
(b)  Torque  at  the  second  joint 


(a)  Kq_ff  w/Ule 


(b)  Kq_ff  w/U2e 


D2_o  [m] 


Figure  4-5  Modal  stiffness  with  disturbance 
(a)  Disturbance  at  the  end  of  the  first  link 
(b)  at  the  end  of  the  second  link 


(a)  modal  mass  w/TI 


Figure  4-6  Modal  mass  with  joint  input 
(a)  Torque  at  the  first  joint 
(b)  Torque  at  the  second  joint 
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objective  function.  There  are  several  schemes  to  find  the  solution  of 
minimization  problems.  This  study  adopts  the  direct-search  method  so  that 
the  objective  function  is  evaluated  for  all  data  points  without  using 
derivatives.  The  three  objective  functions  used  in  this  study  are  based  on 
the  natural  frequency,  impulse  response,  and  modal  stiffness. 


Structural  Optimization  Based  on  Natural  Frequency 

The  natural  frequency  is  the  most  important  property  for  an 
oscillatory  system.  This  structural  characteristic  affects  settling  time, 
position  accuracy,  and  the  cut-off  frequency  of  the  controller.  The 
objective  function  considered  in  this  section  includes  the  natural  frequency 
for  better  response  and  the  mass  to  minimize  weight  of  the  system.  Two 
different  natural  frequencies  are  considered  that  correspond  to  the  joint- 
locked  and  joint-free  cases  as  shown  in  Figure  4-2.  These  two  frequencies 
are  combined  to  develop  new  contour  plots  and  an  optimal  structure  can  be 
found  by  adding  mass.  The  objective  function,  therefore,  is  written  as 


f i i 

U,  = norm(M)  + SF,  x norm( ) + SF?  * norm( ) 

V fn  f fn  rf ) 


(4-3) 


where  SF^2  are  scale  factors. 

The  significance  of  the  different  objectives  can  be  scaled  by  the 
weighting  factor  or  scale  factor.  This  study  uses  two  assumptions:  first, 
the  two  natural  frequencies  have  equal  importance  and,  second,  the  mass 
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and  natural  frequency  also  have  the  same  significance.  The  general  way  of 
scaling  due  to  the  difference  of  variation  can  be  written  as 


SF  _ (max-  min)  of  variable  1 
(max-  min)  of  variable  2 


(4-4) 


This  scale  factor  can  become  unreasonable  when  components  of  the 
variables  have  extreme  values  due  to  nonlinear  properties.  These  extreme 
values  should  be  excluded  in  the  calculation  of  the  scale  factor  and,  in 
some  cases,  the  mean  value  of  two  variables  can  be  used  in  the  scaling.  No 
systematic  way  exists  to  find  the  scale  factor,  but  Equation  (4-4)  is  chosen 
to  give  a reasonable  value  in  this  study. 

Two  contour  plots  of  the  performance  index  are  shown  in  Figure  4-7. 
The  static  case  with  the  joints-locked  as  illustrated  in  Figure  4-2  showed 
that  the  diameter  of  the  first  link  should  be  larger  than  that  of  the  second 
link  and  the  dynamic  case  with  joints-free  showed  opposite  results.  When 
two  natural  frequencies  are  combined  with  equal  importance  in  the 
objective  function,  the  scale  factor,  SF2,  was  found  to  be  0.95.  The 
resulting  optimal  line  in  Figure  4-7  (a)  is  Dl  = l 0539*D2-0.0107  and 
suggests  that  the  two  diameters  of  the  manipulator  should  be  almost  the 
same.  Gravity  is  not  considered  here  and  the  effect  of  gravity  may  shift  the 
optimal  line  upwards  to  decrease  inertia  by  reducing  the  size  of  the  second 
link.  When  the  diameter  of  the  first  link  is  less  than  0.15m,  values  of  the 
objective  function  change  sharply  and  this  design  region  is  undesirable  due 
to  the  high  sensitivity  to  change  in  the  design  variables.  This  plot  shows 
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(a)  PI  w/fn 


D2_o  [m] 


Figure  4-7  Contour  plot  of  PI  with  clamped  free  model 
(a)  PI  with  frequencies  (joint  locked  and  unlocked) 
(b)  PI  with  mass  and  frequencies 
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robust  design  with  small  variation  of  the  objective  function  when  the 
diameters  are  larger  than  0.18m.  The  goal  is  minimization  of  the  objective 
function  and  larger  diameters  of  both  links  show  better  performances 
without  mass  consideration  in  Figure  4-7  (a).  The  best  structure  in  this 
case  can  be  selected  with  diameters,  Dl=0.3m  and  D2=0.3m,  where  these 
are  constrained  by  their  upper  limits. 

When  mass  minimization  is  included  in  the  objective  function,  large 
diameters  for  both  links  reduce  the  design  merit.  The  scale  factor  SFi  is 
calculated  based  on  Equation  (4-4).  The  minimum  and  the  maximum  values 
of  two  variables  are  chosen  along  the  optimal  line  and  SF[  was  calculated 
to  be  0.585.  Optimal  diameters  of  the  two  link  manipulators  based  on  this 
weighting  factor  were  found  to  be  Dl=  0.18m  and  D2=0.18m  as  in  the 
contour  plots  in  Figure  4-7  (b).  The  numbers  on  the  curves  represent  the 
calculated  objective  function  based  on  Equation  (4-3)  and  this  value  at  the 
optimal  point  is  0.729.  The  mass  of  the  optimum  two  links  in  Figure  4-7 
(b)  is  decreased  by  64  percent  from  the  optimal  case  in  Figure  4-7  (a). 
This  final  optimum  design  has  the  same  size  of  link  diameters  and  is  well 
within  the  constraints  imposed  on  the  diameters.  The  corresponding 
system  natural  frequencies  are  0.538  Hz  for  the  joint-locked  case  and  12.71 
Hz  for  the  joint-free  case. 

The  same  optimization  scheme  was  performed  with  the  clamped  mass 
model  for  comparison  and  the  results  are  plotted  in  Figure  4-8.  When  two 
natural  frequencies  are  combined,  the  line  equation  of  the  optimal  structure 
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(b)  PI  w/mass  and  fn 


D2_o  [m] 


Figure  4-8  Contour  plot  of  PI  with  clamped  mass  model 
(a)  PI  with  frequencies  (joint  locked  and  unlocked) 
(b)  PI  with  mass  and  frequencies 
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based  on  frequency  consideration  is  Dl  = l ,2059*D2-0.003  with  scale  factor 
SF2  0.99  in  Figure  4-8  (a).  This  result  implies  that  the  optimal  first  link 
diameter  is  16  percent  larger  than  that  of  the  second  link.  After  the  mass 
is  added  with  scale  factor  SFt  0.59,  Figure  4-8  (b)  shows  the  optimal 
solution  to  be  Dl=0.18m  and  D2=0.16m.  The  scale  factor  is  calculated  in 
the  same  way  as  in  the  previous  case.  The  natural  frequencies  of  this 
structure  are  0.485  Hz  for  the  joints-locked  case  and  1.425  Hz  for  the 
joints-free  case.  This  structure  has  same  size  for  the  first  link  and  11 
percent  smaller  diameter  for  the  second  link  compared  to  the  optimal 
structure  for  the  clamped  free  model  in  Figure  4-7  (b).  Optimization  of  the 
clamped  mass  model  reduced  system  inertia  by  decreasing  the  size  of  the 
second  link.  The  high  gradients  in  Figure  4-8  (b)  imply  that  smaller 
diameters  of  the  first  link  are  inadvisable  for  the  optimal  structure  due  to 
the  sensitivity  of  the  design  to  diametric  variations. 

Structural  Optimization  Based  on  Modal  Stiffness 

Stiffness  is  an  important  characteristic  due  to  its  direct  effects  on 
manipulator  accuracy.  This  section  considers  an  optimization  based  on 
modal  stiffness  with  mass  effect.  The  stiffness  depends  on  general  input 
location  and  will  be  investigated  with  two  torque  inputs  and  two 
disturbances.  The  optimization  scheme  uses  the  dynamic  stiffness  of  the 
first  mode  of  vibration.  Static  stiffness  is  also  an  important  characteristic 
but  it  is  excluded  here  due  to  neglecting  gravity  for  the  space  manipulator. 
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The  objective  function  includes  the  modal  stiffness;  because  the  goal 
is  minimization  of  the  objective  function,  the  inverse  of  the  modal  stiffness 
is  used.  System  stiffness  depends  on  the  location  of  the  general  torque 
input.  Since  there  are  two  torque  inputs,  the  objective  function  uses  a 
combination  of  these  inputs.  By  adding  the  mass  effect,  the  objective 
function  is  written  as 


norm(M)  + SF,  x 

Lm(±) 

+ SF,  * norm(— ) 

\ 

l kq 

/T1  kq 

w / T1  ^ 

w / T2' 

This  study  assumes  that  the  two  torque  inputs,  the  mass  and  the  stiffness 
have  equal  importance.  Accordingly,  the  scale  factors  are  based  on  the 
range  of  the  variation  of  the  mass  and  the  two  modal  stiffness. 

First,  the  two  modal  stiffness  results  in  Figure  4-4  are  combined;  the 
resulting  merit  contours  are  plotted  without  the  mass  effect  in  Figure  4-9 
(a).  The  range  of  the  variation  of  the  variables  was  chosen  from  the 
optimal  lines  in  Figure  4-4;  the  scale  factor  SF2  used  in  this  case  is  0.049. 
The  optimal  line  for  the  stiffness  is  Dl  = 1.539*D2-0.095  with  the  general 
torque  inputs.  The  high  gradients  at  the  lower  right  side  indicate  that  a 
smaller-diameter  first  link  and  a larger-diameter  second  link  are  poor 
design  selections.  The  best  structure  without  consideration  of  mass  is 
Dl=0.3m  and  D2=0.257.  The  contour  plots  in  Figure  4-9  (b)  show  that  the 
optimal  diameters  are  Dl=0.18m  and  D2=0.18m  when  including  the  effect 
of  the  mass  with  scale  factor  SFi  16.8.  This  factor  was  calculated  as  in 


(a)  Kq_rf  w/T  1 and  T2 


(b)  PI  w/mass  and  Kq_rf(T  1 and  T2) 


Figure  4-9  Contour  plot  of  PI  with  torque  inputs 
(a)  PI  with  stiffness;  (b)  PI  with  mass  and  stiffness 
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the  previous  cases.  This  optimal  structure  shows  the  same  size  for  the  two 
links  and  its  calculated  objective  function  is  0.046. 

Stiffness  also  differs  when  there  are  general  disturbances  at  the  end 
of  the  joints.  This  study  assumes  that  the  effects  of  these  general 
disturbances  are  identical.  The  same  objective  function  is  used  as  in 
Equation  (4-5),  but  the  system  inputs  are  changed  from  the  general  joint 
torque  inputs  to  the  general  disturbances  at  the  end  of  each  link.  The  two 
plots  in  Figure  4-5  are  combined  with  a scale  factor  SF2  1.00  based  on 
Equation  (4-4).  The  resulting  iso-merit  contours  for  the  stiffness 
optimization  are  plotted  in  Figure  4-10  (a).  The  optimal  line  based  on 
stiffness  is  D 1 = 1 169*D2-0.001  for  the  general  disturbances.  The  contour 
plots  in  the  figure  imply  that  the  first  link  is  14  percent  larger  than  the 
second  link  based  on  the  disturbance  effects.  The  contour  plots  in  Figure 
4-10  (b)  include  the  effect  of  the  mass  with  scale  factor  SF!  1.88.  This 
factor  is  calculated  as  in  the  previous  cases.  The  optimal  structure  is 
found  to  have  Dl=0.17m  and  D2=0.15m  with  a difference  between  the  two 
diameters  of  approximately  12  percent.  The  calculated  objective  function 
is  0.539  at  this  optimal  point. 

Structural  Optimization  Based  on  Impulse  Response 

The  optimization  for  the  minimization  of  the  vibration  amplitude  can 
be  pursued  by  using  the  impulse  response.  The  response  of  a second  order 
system  excited  by  an  impulse  I can  be  written  as 


(a)  Kq_ff  and  Dist.  at  Ule  and  U2e 


(b)  PI  w/mass  and  Kq_ff(U1e  and  U2e) 


Figure  4-10  Contour  plot  of  PI  with  disturbances 
(a)  PI  with  stiffness;  (b)  PI  with  mass  and  stiffness 


I 


63 


x(t) 


I . , , 1 

sm(cynt)  = 


mxffl. 


Vm  x k 


sin(<yn  t) . 


(4-6) 


This  equation  implies  that  higher  values  of  the  product  of  modal  mass  and 
modal  stiffness  decrease  the  vibration  of  a structure.  This  also  means  that 
one  of  these  properties  -natural  frequency,  stiffness,  or  mass-  can  be 
chosen  to  decrease  the  oscillation.  If  damping  is  considered,  then  the 
response  contains  the  exponential  term  representing  the  decay  of  the 
transient  response.  Note  that  the  amplitude  of  the  steady  state  response  of 
a second  order  system  at  the  natural  frequency  is 

F 


X = 


2kC 


(4-7) 


where  X and  F are  the  magnitude  of  response  and  input  force  and  C,  is  the 
damping  ratio.  This  response  shows  that  the  magnitude  is  only  a function 
of  the  stiffness  and  the  damping.  The  modal  mass  and  the  natural 
frequency  do  not  effect  the  magnitude  of  the  vibration  at  resonance. 
Accordingly,  if  the  system  has  external  steady  inputs  such  as  in  a machining 
environment,  then  Equation  (4-7)  is  important.  This  study  assumes  that 
there  are  no  steady  inputs  and  that  transient  vibration  response  is  the  only 
important  consideration  in  flexible  manipulator  dynamics.  Therefore, 
minimization  of  the  impulse  response  is  chosen  for  the  objective  function. 

Two  different  inputs,  i.e.,  any  general  torque  inputs  and  any  general 
disturbances,  are  investigated.  The  modal  parameters  with  two  joint  inputs 
are  used  from  Figure  4-4  and  4-6.  For  input  at  the  first  joint,  the  modal 
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products  are  plotted  in  Figure  4-11  (a).  The  optimal  line  in  this  case  is 
Dl=4.693 *D2-0.303  for  the  minimum  vibration  with  minimum  mass.  The 
best  structure  on  this  line  has  Dl=0.3m  and  D2=0.13m  where  D1  is 
constrained  by  its  upper  limit  and  the  difference  of  two  diameters  is  57 
percent.  This  structure  shows  the  largest  difference  in  size  between  the 
two  diameters.  When  the  input  is  at  the  second  joint,  the  optimal  line  for 
the  minimum  weight  and  vibration  is  Dl  = l . 101  *D2-0.067.  This  implies 
that  a larger  diameter  of  the  second  link  is  preferred  for  inputs  at  the 
second  joint.  Figure  4-12  shows  the  contour  plot  with  disturbances  at  the 
end  of  each  link  based  on  first  mode  response.  There  are  no  optimal  lines 
in  the  contour  plot  in  this  case.  Since  the  disturbances  are  affecting  the 
first  mode  of  each  link,  the  response  improves  by  increasing  the  diameter 
of  the  link  that  is  subjected  to  the  disturbance. 

Since  higher  values  for  the  product  of  modal  mass  and  modal 
stiffness  produce  a smaller  vibration  response,  the  inverse  of  this  product 
is  used  for  the  objective  function  in  the  minimization  problem.  This  study 
assumes  that  two  products  plotted  in  Figure  4-11  and  4-12  have  equal 
importance  when  combined  in  the  objective  function.  First,  the  modal 
parameters  are  combined  from  two  plots  of  Figure  4-11  and  4-12  with  scale 
factor  SF2.  After  including  the  mass  of  the  manipulator  with  scale  factor 
SFi,  the  objective  function  can  be  written  as 


D1_o  [m] 
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(a)  mq11*kq11  w/TI 


Figure  4-11  Product  of  modal  mass  and  modal  stiffness  with  torque  inputs 
(a)  mq*kq  with  Tl;  (b)  mq*kq  with  T2 
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(a)  mq_f1 1 *kq_f1 1 w/  U1  e 


Figure  4-12  Product  of  modal  mass  and  modal  stiffness  with  disturbances 

(a)  mq*kq  with  disturbance  at  Ule 

(b)  mq*kq  with  disturbance  at  U2e 
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U3  = norm(M)  + SF,  x 


norm( 


1 


mq  x kq 


+ SF2  * norm( ) 

w/ti  mqxkq 


(4-8) 


<r/  T2' 


The  system  subjected  to  general  torque  inputs  is  first  investigated.  The 
scale  factor  is  calculated  based  on  Equation  (4-4)  and  the  range  is  chosen 
from  the  optimal  lines.  The  scale  factor  SF2  is  1.638e-4  in  Equation  (4-8) 
and  the  resulting  contours  without  mass  are  plotted  in  Figure  4-13  (a). 
The  optimal  line  in  this  case  can  be  determined  as  Dl=  1 959*D2-0. 1275 
and  the  optimal  point  is  Dl=0.3m  and  D2=  0.22m  where  D1  is  constrained 
by  its  upper  limit.  After  including  mass  in  the  objective  function,  Figure  4- 
13  (b)  is  plotted  based  on  Equation  (4-8)  with  scale  factor  SFi  1.146e4  and 
the  optimal  structure  has  Dl^  0.18m  and  D2=0.16m  with  the  calculated 
objective  function  as  6.678e-5.  There  is  a 68  percent  decrease  in  the  mass 
of  the  optimal  structure  when  the  mass  is  included  in  the  objective 
function. 


The  effect  of  the  disturbances  with  the  joint-locked  is  investigated 
here  by  changing  the  system  inputs  from  general  joint  torque  to  general 
disturbances.  The  two  plots  for  the  modal  parameters  in  Figure  4-12  are 
combined  with  scale  factor  SF2  1.00.  Figure  4-14  (a)  shows  that  the 
optimal  line  is  Dl  = l .403  *D2-0. 0044  for  the  minimal  vibration  for 
disturbances  at  the  end  of  each  link.  After  including  mass  effects  with 
scale  factor  SFi  2.19,  the  contours  are  plotted  in  Figure  4-14  (b).  It  can 
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(a)  mq*kq  w/TI  and  T2 

*4» 


D2_o  [m] 


Figure  4-13  PI  based  on  the  product  of  modal  mass  and  stiffness 
with  general  joint  torque  inputs 

(a)  PI  with  mq*kq  with  T1  and  T2;  (b)  PI  with  mass  and  mq*kq 
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(a)  mq*kq  w/dist.  at  Ule  and  U2e 


D2_o  [m] 


Figure  4-14  PI  based  on  the  product  of  modal  mass  and  stiffness 

with  general  disturbances 
(a)  PI  with  disturbances  at  ends  of  the  each  link 
(b)  PI  with  mass  and  disturbances 
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be  seen  that  the  optimal  structure  has  Dl=0.19m  and  D2=0.14m  and  that 
the  calculated  objective  function  is  0.253  at  the  optimal  point. 

Summary  and  Discussion 

A structural  optimization  procedure  was  performed  in  this  chapter 
based  on  the  natural  frequency,  modal  stiffness,  and  modal  mass  for  general 
torque  and  general  disturbance  inputs.  The  study  performed  here  is 
different  from  designing  a general  industrial  manipulator  because  of  several 
assumptions: 

(a)  There  is  no  gravity  in  the  planar  motion  so  that  static  stiffness  is 
excluded.  This  would  be  inadequate  if  a long-arm  manipulator 
were  used  in  the  gravitational  field. 

(b)  Two  natural  frequencies  only  are  considered  and  are  assumed  to 
have  the  same  importance  whether  the  joints  are  locked  or  free. 

(c)  Mass  and  the  other  system  dynamic  properties  (fn,  kq,  mq*kq) 
are  assumed  to  have  the  same  importance  in  selecting  link 
diameters.  The  weighting  factors  of  these  different  properties  in 
general  would  depend  on  the  application  of  the  robot. 

(d)  The  responses  of  the  system  to  the  two  general  torque  inputs  or 
the  two  general  disturbances  inputs  are  assumed  to  be  equally 
important. 

These  assumptions  as  well  as  the  choice  of  the  scale  factors  clearly 
produce  different  results. 
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Another  important  consideration  is  the  beam  models,  e g.,  clamped 
free  and  clamped  mass.  In  reality,  the  modeling  would  depend  on  the  joint 
conditions;  accordingly,  this  study  adopted  the  two  models  for  frequency 
optimization.  The  dominant  natural  frequencies  of  the  two  models  were 
almost  same  for  the  joint-locked  condition  but  were  quite  different  for  the 
joint-free  condition.  The  optimal  relationship  between  the  link  diameters 
was  found  to  be  linear  and  were  plotted  for  the  highest  frequencies  with 
minimum  mass  in  Figure  4-15.  The  two  models  show  different  optimal 
linear  relationships  and  the  clamped  mass  model  has  larger  first  link  and 
smaller  second  link  diameters  compared  to  the  clamped  free  model.  This 
implies  that  more  independent  and  complex  joint  conditions  would  increase 
the  ratio  between  the  diameters.  When  there  is  a mass  constraint  of  200 
Kgm  on  the  whole  system,  the  clamped  free  model  has  same-sized  links 


fn  w/  clamped  mass  and  free  mode 


Figure  4-15  Optimal  lines  with  different  mode  shapes 
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while  the  clamped  mass  model  shows  16  percent  difference  between  the 
two  diameters. 

Two  optimization  objectives,  namely,  the  natural  frequency  and 
stiffness,  are  commonly  used  in  structural  design.  The  impulse  response  is 
normally  used  in  control  and  vibration  theory.  Both  of  these  objectives  are 
considered  for  the  structural  optimization  in  this  study.  Optimization 
based  on  modal  stiffness  and  impulse  response  showed  that  the  optimal 
solution  depends  on  input  torque  location.  The  link  with  a torque  input  or 
a disturbance  input  is  found  to  be  larger  than  the  other.  Two  performance 
indexes  were  combined  with  a scale  factor  and  the  results  are  plotted  for 
comparison  in  Figure  4-16  based  on  the  clamped  free  model.  The  plots 
indicate  that  including  the  modal  mass  requires  that  the  system  have  a 
larger-diameter  first  link  and  a smaller-diameter  second  link  in  both  cases. 
Figure  4-17  shows  the  optimal  lines  for  the  joint-locked  case  with  the 
clamped  free  model  based  on  the  flexible  mode  mass  and  stiffness  matrices. 
The  plot  in  Figure  4-17  (a)  shows  close  results  for  the  two  optimal  lines 
based  on  the  dominant  flexible  mode  frequency  and  on  the  product  of  the 
modal  mass  and  the  modal  stiffness  with  disturbances  at  the  end  of  each 
link.  The  plot  in  Figure  4-17  (b)  shows  different  results  for  the  optimal 
lines  based  on  the  dominant  flexible  mode  frequency  and  on  the  modal 
stiffness  with  disturbances  at  the  end  of  the  each  link.  The  optimization 
based  on  the  modal  stiffness  produces  a larger  diametric  ratio  D2/D1  for 


the  links. 


D1_o  [m]  D1_o  [m] 
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(a)  Mq*Kq  and  Kq  w/torque 


(b)  MqKq  and  Kq  w/  dist. 


Figure  4-16  Optimal  lines  with  different  objective  functions 

(a)  Optimal  lines  with  torque  inputs 

(b)  Optimal  lines  with  disturbances 


(a)  fn  and  Mq*Kq  w/joint-locked 


Figure  4-17  Optimal  lines  with  different  objective  functions 
with  joint-locked  condition 

(a)  Optimal  lines  based  on  frequency  and  product 

of  the  modal  mass  and  modal  stiffness 

(b)  Optimal  lines  based  on  frequency  and  stiffness 


CHAPTER  5 

OPTIMIZATION  OF  SYSTEM  WITH  CONTROLLER 
FOR  ROBUST  DESIGN 

Introduction 

A methodology  for  the  design  of  a two  link  manipulator  by  using  a 
controller  in  the  design  stage  is  proposed  in  this  chapter.  In  general,  the 
structural  design  and  the  controller  design  are  not  commonly  coupled.  The 
structural  designer  performs  the  manipulator  design  using  structural 
characteristics.  The  goal  of  the  structural  designer  is  to  find  an  optimal 
system  that  satisfies  the  mechanical  constraints.  The  previous  chapter  is  an 
example  of  structural  optimization  from  the  mechanical  viewpoint.  The 
controller  designer  is  generally  uninvolved  in  the  mechanical  design 
process.  He  incorporates  a mechanical  structure  in  the  control  loop  and 
finds  a controller  that  maximizes  manipulator  performance.  Although  the 
mechanical  structure  and  controller  are  optimized  independently  in  this 
uncoupled  design  approach,  the  results  do  not  guarantee  that  the 
mechanical  structure  is  optimal  within  the  controller  loop. 

The  optimal  structure  as  determined  in  the  previous  chapter  is  based 
on  the  objective  functions  of  using  the  mass  and  the  flexible  mode 
characteristics  so  that  it  basically  utilizes  only  mechanical  criteria.  The 
proposed  design  approach  proceeds  to  modify  the  dimensions  of  the 
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structurally  optimized  system  by  including  the  controller  effect.  If  the 
controller  selection  is  based  on  the  rigid  mode,  then  including  the 
controller  in  the  design  stage  has  the  equivalent  effect  of  including  the 
rigid  mode  in  the  structural  design.  If  it  is  based  on  the  flexible  mode, 
then  the  controller  effects  will  improve  the  flexible  mode.  This  study  uses 
a PD  (proportional  and  derivative)  controller  based  on  the  rigid  mode.  The 
rigid  mode  performance  is  governed  by  the  controller  and  the  flexible  mode 
performance  is  governed  by  the  structural  characteristics. 

The  PD  controller  provides  structural  benefits  when  utilized  in  the 
design  stage.  The  proportional  gain  behaves  as  a stiffness  and  the 
derivative  as  a damper  in  the  rigid  mode.  Therefore,  including  the  PD 
controller  completes  the  model  of  a manipulator  system  by  allowing  it  to 
have  mass,  damping,  and  stiffness  in  the  rigid  mode.  The  modal  approach 
can  be  used  to  derive  the  structural  parameters  for  the  rigid  mode  even 
though  these  are  based  on  the  behavior  of  the  electric  circuit  of  the 
controller.  The  resulting  manipulator  has  all  structural  parameters  in  both 
the  rigid  and  flexible  modes. 

As  mentioned  in  the  literature  review,  Park  and  Adada41  included  the 
controller  in  the  design  of  a two  link  manipulator  by  using  the  rigid  mode 
frequency.  This  study  proposes  a different  approach  by  including  the 
controller  effects  in  the  structural  optimization  process.  The  structural 
optimization  discussed  in  the  previous  chapter  will  be  extended  to  consider 
the  rigid  mode. 
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This  chapter  is  organized  in  the  following  order.  A simple  controller 
will  be  constructed  based  on  the  classic  control  theory  and  the  system  will 
be  formulated  to  include  the  controller  effects.  The  optimal  structure, 
based  on  the  natural  frequencies  from  the  previous  chapter,  will  be  used  as 
the  initial  structure.  Both  the  clamped  free  and  clamped  mass  models  are 
used  to  check  the  effect  of  the  developed  concept  on  each  model.  After 
determining  new  optimal  mechanical  structures,  their  performances  will  be 
compared  with  that  of  the  initial  structures  for  the  rigid  and  flexible  modes. 

Controller  Design 

This  section  presents  the  controller  design  procedure.  The  PD 
controller  used  in  this  study  has  two  gains  for  each  link  so  that  four  gains 
should  be  determined  according  to  appropriate  controller  design  methods. 
One  of  the  general  methods  is  pole  assignments  and  the  control  gains  can 
be  chosen  by  assigning  poles  that  are  functions  of  the  natural  frequency  and 
damping.  The  controller  frequency  of  the  rigid  mode,  generally,  is 
constrained  to  be  less  than  a half  of  the  lowest  natural  frequency  of  the 
flexible  mode  in  order  not  to  excite  the  dominant  flexible  mode.10  The 
optimal  damping  ratio  for  the  second  order  system  is  0.707  based  on  the 
ITAE  (the  integral  of  time  multiplied  by  the  squared  error)  criterion.  This 
damping  ratio  also  guarantees  that  the  magnitude  of  the  nondimentional 
transfer  function  between  spring  force  due  to  dynamic  displacement  and  the 
input  force  is  less  than  1 for  any  steady  state  exciting  frequency.  These 
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conditions  are  used  to  calculate  the  controller  gains.  In  reality,  the 
differential  controller  is  not  used  alone  without  additional  low-pass  filters 
because  of  stability  problems.  It  is  used  here  as  a tool  in  the  design  stage 
and  not  for  actual  control  of  the  manipulator. 

Three  considerations  are  assumed  in  the  simulation  of  the  control 
system.  First,  there  is  an  upper  limit  for  the  input  torque  on  the 
manipulator  that  has  the  equivalent  effect  of  voltage  or  current  limit. 
Second,  the  electric  time  constant  of  the  motor  is  assumed  to  be  much 
taster  than  the  mechanical  time  constant.  This  makes  it  possible  to  treat 
the  motor  itself  as  a constant  gain  instead  of  a first  order  system  so  that 
the  motor  can  be  modeled  as  a part  of  the  proportional  controller  gain. 
Third,  the  position  and  velocity  control  operate  in  the  continuous  time 
domain  so  that  high  frequency  effects  are  detectable  in  the  simulation  due 
to  the  very  small  time  steps.  The  time  step  normally  depends  on  the  time 
constant  of  the  system  so  that  the  sampling  frequency  is  chosen  at  least  10 
times  higher  than  the  highest  natural  frequency  of  the  whole  system. 

The  initial  system  used  is  the  structurally  optimized  manipulator  as 
determined  in  last  chapter  with  the  clamped  free  model.  The  diameters  are 
0.18m  for  both  links  and  the  dominant  natural  frequency  is  0.5369  Hz  for 
the  joint  locked  case  and  12.6256  Hz  for  the  joint  free  case.  The  natural 
frequency  for  the  joint-locked  case  is  used  to  calculate  the  cut-off 
frequency  of  the  controller.  The  controller  gains  are  decided  based  on  this 
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initial  system  and  the  resulting  controller  gains  will  be  used  to  include  the 
controller  effects  on  the  system  design. 

The  PD  controller  has  two  gains  for  each  joint  so  that  four  gains 
should  be  determined  for  the  whole  system.  Figure  5-1  shows  the  block 
diagram  of  the  whole  system  with  the  PD  controller  and  the  flexible 
manipulator.  The  control  loop  contains  two  structural  and  four  control 
design  variables.  The  controller  can  be  selected  based  on  either  rigid  mode 
or  flexible  mode  characteristics,  but  only  the  rigid  mode  will  be  used  for 
the  controller  design  in  this  study.  The  resulting  controller  has  two  natural 
frequencies  for  the  rigid  mode,  which  are  relatively  low  compared  to  the 
flexible  mode  frequency.  They  will  not  excite  the  dominant  flexible  mode. 


Figure  5-1  Control  system 

The  control  gains  are  designed  according  to  the  following  procedure. 
The  rigid  mode  mass  matrix  (Mrr)  and  independent  joint  controller  (two 
proportional  and  two  derivative  gains)  can  be  written  as 
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= 0 


(5-1) 
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where  Kpl  and  Kp2  are  the  proportional  gains  for  the  first  and  the  second 
links  and  Kvl  and  Kv2  are  the  derivative  gains  for  the  two  links.  This 
system  is  coupled  dynamically  because  of  the  mass  matrix,  which  can  be 
converted  into  two  independent  modal  equations.  The  pole  assignment  can 
be  used  to  make  the  system  exhibit  the  desired  structural  properties.  The 
rigid  mode  controller  has  two  natural  frequencies.  The  higher  natural 
frequency  of  the  controller  is  selected  to  be  close  to  one  half  of  the  lowest 
natural  frequency  of  the  flexible  mode  with  joint  locked;  the  lower  natural 
frequency  of  the  controller  is  chosen  to  be  as  high  as  possible.  These  two 
controller  design  objective  can  be  used  to  find  two  proportional  gains,  Kpl 
and  Kp2.  The  resulting  objective  function  can  be  written  as 


U4  = norm 


' lj 

Vfn  rf 


+ WF,  x norm 


1- 


fn  r2 


fn_r2_diy 


(5-2) 


where  norm  is  normalization  of  a matrix  with  respect  to  its  maximum 
value,  fn  rl  and  fn_r2  are  the  first  and  the  second  mode  frequencies  of  the 
controller;  fn_r2_d  is  the  desired  second  mode  frequency  of  the  controller, 
which  is  half  of  the  first  flexible  mode  frequency;  and  WFi  is  the  weighting 
factor. 


The  derivative  gains  of  the  controller  will  change  the  damping  of  the 
system.  One  consideration  in  finding  the  derivative  gains  is  that  the 
damping  ratio  of  the  first  mode  of  the  controller  is  chosen  to  be  close  to 
0.707.  Another  consideration  is  to  minimize  the  coupling  of  the  two  rigid 
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modes  in  the  modal  space  by  decreasing  the  off-diagonal  terms  of  the 
modal  damping  matrix.  Accordingly,  the  objective  function  for  these 
considerations  can  be  staged  as 


U5  = norm 


Cl 


0.707  ) 


+ WF,  x norm([off  - diag  of  [Cq]])  (5-3) 


where  C, t is  the  damping  ratio  of  the  first  mode  of  the  controller  and  [Cq]  is 
the  modal  damping  matrix. 

The  normalized  objective  functions  based  on  Equation  (5-2)  and  (5- 
3)  are  calculated  with  a range  of  controller  gains.  The  weighting  factors 
WFi  and  WF2  are  chosen  as  1 for  both  Equations  (5-2)  and  (5-3)  and  the 
resulting  contours  of  the  performance  index  are  plotted  in  Figure  5-2.  The 
optimal  proportional  controller  gains  are  found  to  be  Kpl=4700  and 
Kp2=l  100,  which  correspond  to  controller  frequencies  of  0.0505  Hz  and 
0.2686  Hz  in  the  modal  space.  The  derivative  gains  are  Kvl=21000  and 
Kv2=4900  and  the  corresponding  damping  ratio  is  0.7074  for  the  first 
mode  of  the  controller.  Equations  (5-4)  and  (5-5)  show  the  resulting 
formulation  in  the  general  coordinates  and  the  modal  coordinates 
respectively. 
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Figure  5-2  Contour  plot  for  control  gains 
(a)  PI  for  proportional  gains 
(b)  PI  for  derivative  gains 
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The  magnitude  of  the  off-diagonal  term  of  the  modal  damping  matrix  is  64, 
which  is  0.16  percent  of  the  smaller  diagonal  term  (39931)  of  the  modal 
damping  matrix.  The  resulting  damping  ratio  is  3.76  for  the  second  mode 
of  the  controller.  The  programs  used  for  the  controller  design  are  listed  in 
Appendix  D. 

Structural  Optimization  Including;  Controller  Effects 
This  section  presents  the  procedure  of  including  the  controller 
effects  in  the  system  design  with  the  clamped  free  model.  The  controller 
used  in  the  process  is  based  on  the  rigid  mode  so  that  the  system 
performance  of  the  rigid  mode  is  expected  to  be  improved.  The  three 
optimization  schemes  used  in  the  structural  design  of  the  last  chapter  are 
extended  to  include  the  controller  effects.  Accordingly,  the  performance 
indexes  are  expressed  as  functions  of  the  natural  frequency,  of  the  modal 
stiffness,  and  of  the  product  of  the  modal  mass  and  modal  stiffness  in  the 
rigid  mode  control  system. 

When  performance-index  variables  are  considered  in  the  rigid  mode, 
they  should  be  changed  to  reflect  the  different  characteristics  of  the  rigid 
and  the  flexible  modes.  For  example,  a higher  value  of  the  product  of  the 
modal  mass  and  modal  stiffness  would  be  desirable  in  order  to  minimize  the 
vibration  in  the  flexible  mode.  On  the  other  hand,  a lower  value  is 
preferred  for  improving  the  system  response  in  the  rigid  mode.  The  modal 
stiffness  in  the  rigid  mode  should  be  interpreted  differently  than  in  the 
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flexible  mode.  The  higher  modal  stiffness  in  the  flexible  mode  implies  a 
stiffer  link  or  smaller  structural  vibration.  The  higher  stiffness  in  the  rigid 
mode  implies  a powerful  and  stiff  controller  with  higher  proportional  gains. 

The  Effect  of  Including  Natural  Frequency  of  Controller 

First,  the  natural  frequency  of  the  rigid  mode  controller  is  used  to 
illustrate  the  contributions  that  the  controller  can  make  to  the  structural 
optimization  process.  The  two  proportional  gains  are  fixed  and  the  rigid 
mode  natural  frequencies  are  calculated  by  changing  the  diameters  within 
the  constraints.  The  first  mode  frequency  of  the  controller  is  plotted  in 
Figure  5-3  (a).  The  frequency  of  the  rigid  mode  is  much  more  dependent 
on  the  diameter  of  the  second  link  and  the  first  link  has  little  effect  on  the 
frequency.  The  frequencies  in  Figure  5-3  (a)  do  not  show  significant 
change  because  the  main  factor  of  this  frequency  is  the  lengths  rather  than 
the  diameters  of  the  manipulator.  If  the  effect  of  this  natural  frequency  is 
included,  the  diameter  of  the  second  link  is  expected  to  decrease  more  than 
the  first  link. 

The  inverse  of  this  natural  frequency  is  used  for  the  minimization 
problem  and  its  normalized  values  are  incorporated  in  the  objective 
function.  The  resulting  objective  function  is  the  summation  of  the  first 
rigid  mode  frequency  effects  and  the  flexible  mode  effects  from  the 
objective  function  Ui  in  Equation  (4-3).  It  can  be  written  in  the  following 


form 


D1_o[m]  D1_o  [m] 
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(a)  fn_r1  [Hz] 


(b)  PI  w / controller  effects 


Figure  5-3  Including  the  natural  frequency  of  the  controller 
(a)  First  mode  frequency  of  the  rigid  mode  control  system 
(b)  PI  with  controller  effects 
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U6  - norm 


fn  rlj 


+ SF3  x norm(U1) 


(5-6) 


where  SF3  is  the  scale  factor  based  on  Equation  (4-4)  and  fn  rl  is  the  first 
mode  controller  frequency  from  Figure  5-3  (a). 

The  normalized  values  of  the  performance  index  U6  are  plotted  in 
Figure  5-3  (b)  with  the  calculated  scale  factor  SF3  0.40.  The  new  optimal 
structure  is  found  to  have  Dl=0.17m  and  D2=0.15m  with  a merit  value  of 
0.8649.  This  new  optimization  scheme  decreased  the  diameters  by  5.5  and 
16.7  percent  for  the  first  and  second  links  respectively.  The  new  optimal 
structure  obtained  with  the  inclusion  of  the  controller  effects  shows  greater 
change  in  the  diameter  of  the  second  link  than  that  of  the  first  link. 
Including  the  natural  frequency  of  the  controller  should  guarantee  that  this 
new  structure  has  better  performance  in  the  rigid  mode,  although 
improvement  in  flexible  mode  performance  is  uncertain.  The  performances 
of  the  initial  and  new  systems  will  be  compared  in  the  next  section. 


The  Effect  of  Including  Modal  Stiffness  of  Controller 

The  modal  stiffness  of  the  rigid  mode  controller  is  considered  here  to 
illustrate  another  way  of  including  the  controller  effects.  The  proportional 
gains  of  the  controller  remain  fixed  while  the  diameters  of  the  links  are 
changeable  within  the  selected  constraints.  The  modal  stiffness  of  the  first 
rigid  mode  is  calculated  by  changing  the  diameters  with  the  two  fixed 
proportional  gains.  The  results  are  presented  in  Figure  5-4  (a)  with  iso- 


[UJ]  O J,Q  [uj]  o IQ 


(a)  kq_r1 


(b)  PI  w/  controller  effects 


Figure  5-4  Including  the  modal  stiffness  of  the  controller 
(a)  First  mode  modal  stiffness  of  the  control  system 
(b)  PI  with  controller  effects 
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merit  contours.  The  higher  value  of  the  modal  stiffness  can  be  explained 
by  proportional  gains  having  more  powerful  effect  on  a given  structure. 
The  best  direction  for  an  initial  structure  to  have  a stiff  and  powerful 
controller  is  the  normal  line  to  the  iso-merit  contours. 

The  higher  stiffness  always  is  preferred  so  that  the  inverse  of  the 
modal  stiffness  of  first  mode  is  used  for  the  minimization  problem  and  its 
normalized  value  is  incorporated  in  the  objective  function.  After  including 
the  objective  function  Uj  in  Equation  (4-3),  the  resulting  objective  function 
can  be  written  in  following  form 


U7  = norm 


' 1 N 

V kq  rlj 


+ SF3  x norn^U,) 


(5-7) 


where  kqrl  is  the  modal  stiffness  of  the  first  mode  of  the  controller  and 


f 1 1 

U,  - norm(M)  + SF,  x norm( ) + SF,  * norm( ) 

V fn_f  ' fn  rf  ) 


It  is  expected  from  Figure  5-4  (a)  that  including  the  modal  stiffness 
of  the  controller  will  decrease  the  diameter  of  both  links.  The  scale  factor 
SF3  is  calculated  based  on  Equation  (4-4)  and  found  to  be  0.214.  By  using 
Equation  (5-7),  the  objective  function  U7  is  calculated  and  plotted  in 
Figure  5-4  (b).  The  new  optimal  diameters  were  found  to  be  Dl=0.16m 
and  D2— 0.15m  with  a merit  value  of  0.9297.  The  optimal  diameters  are 
decreased  by  11.1  and  16.7  percent  for  the  first  and  second  links 
respectively. 
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The  Effect  of  Including  Product  of  Modal  Mass  and  Modal  Stiffness 

The  impulse  response  can  be  used  to  include  the  effects  of  the  rigid 
mode  controller.  The  impulse  response  can  represent  the  total  effect  for 
both  the  rigid  and  flexible  modes.  Theoretically,  the  impulse  input  rarely  is 
applied  directly  to  the  manipulator  system,  but  the  impulse  response 
generally  is  useful  in  finding  an  optimal  structure  with  minimal  vibration. 
In  other  words,  the  product  of  modal  mass  and  modal  stiffness  is  one  of  the 
variables  that  can  improve  the  performances  of  both  the  rigid  and  flexible 
modes.  The  scalar  value  of  this  product  has  different  effects  in  both 
modes;  a higher  value  is  preferred  to  minimize  vibration  of  the  flexible 
mode,  but  a lower  value  is  preferred  for  the  fast  rigid  mode  system. 

The  product  of  the  modal  mass  and  modal  stiffness  is  calculated  by 
using  the  first  mode  of  the  controller  and  is  plotted  in  Figure  5-5  (a).  The 
goal  is  to  minimize  the  value  of  this  product  for  better  rigid  mode 
performance.  It  can  be  seen  from  Figure  5-5  (a)  that  including  this  product 
will  increase  the  diameter  of  the  first  link  but  decrease  that  of  the  second 
link.  The  objective  function  to  include  the  controller  effects  will  use  the 
normalized  value  of  this  product  and  can  be  written  in  following  form 

U8  = norm(mq_rl  x kq_rl)  + SF3  x norm(U,)  (5-8) 

where  mqrl  is  the  first  mode  modal  mass  of  the  control  system. 


D1_o  [m]  D1_o  [m] 


(a)  mq_r1  *kq_r1 


Figure  5-5  Including  the  modal  product  of  the  controller 
(a)  Product  of  the  modal  mass  and  the  modal  stiffness 
(b)  PI  with  controller  effects 
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The  performance  index  is  calculated  based  on  Equation  (5-8)  and  the 
scale  factor  SF3  used  is  0.5671  based  on  Equation  (4-4).  The  normalized 
value  of  this  objective  function  is  plotted  in  Figure  5-5  (b).  The  new 
optimal  structure  has  Dl=0.19m  and  D2=0.15m  with  a merit  value  0.8333. 
This  procedure  increased  the  diameter  of  the  first  link  by  5.5  percent  and 
decreased  that  of  the  second  link  by  16.7  percent. 

Comparison  of  the  Results 

This  section  gives  comparisons  of  the  obtained  results  from  several 
viewpoints  including  the  time  domain  simulation.  The  clamped  free  mode 
is  used  in  the  last  section  and  the  results  from  the  clamped  mass  model  also 
is  discussed  in  this  section. 

All  three  schemes  in  the  last  section  considered  controller  effects 
based  on  the  rigid  mode.  Therefore,  it  is  expected  that  the  rigid  mode 
characteristics  of  the  system  likely  will  be  improved  due  to  the  controller 
effects.  The  resulting  structures  indicate  that  all  three  schemes  produced  a 
smaller  diameter  for  the  second  link,  while  the  diameter  of  the  first  link 
varied  depending  on  the  optimizing  scheme.  The  scheme  based  on  natural 
frequency  and  modal  stiffness  produced  a smaller  diameter  for  the  first 
link.  The  third  scheme  employing  the  impulse  response  indicated  that  a 
larger  first  link  and  a smaller  second  link  will  improve  the  rigid  mode 
dynamics  of  the  manipulator. 
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The  total  response  of  the  system,  including  the  rigid  and  flexible 
modes,  to  a step  input  also  is  investigated.  The  overshoot  for  the  rigid 
mode  and  the  deflection  of  the  end-effector,  ue„d,  for  the  flexible  mode  are 
calculated  based  on  the  following  equations: 


OS(%)  = 

maximum  distance  - desired  distance 

x 100 

(5-9) 

desired  distance 

Uend 

= uie  x cos(02)  + u[E  x L2  + u2E 

(5-10) 

where  the  distance  in  Equation  (5-9)  is  in  x-y  coordinates  and  cos(02)  in 
Equation  (5-10)  gives  the  projection  of  Uie  in  the  normal  direction  at  the 
end-effector.  The  first  and  second  links  are  commanded  to  rotate  10 
degrees  each;  the  controller  gains  obtained  from  Figure  5-2  are  used  for  all 
four  structures  including  the  initial  structure.  Figures  5-6  and  5-7  show 
the  time  response  of  the  original  system,  which  has  D 1=0. 18m  and 
D2— 0.18m.  Figure  5-6  is  plotted  with  the  rigid  mode  response;  the  solid 
line  is  for  0,  and  the  dotted  line  is  for  02  in  Figure  5-6  (a).  The  time 
response  of  the  joints  shows  the  coupling  effects  of  the  two  links  where  the 
second  link  is  rotating  backward  at  the  beginning  in  Figure  5-6  (a).  Figure 
5-6  (b)  is  plotted  in  x-y  coordinates  where  the  initial  point  is  (0,0)  and  the 
circle  with  cross  is  the  target  position.  The  overshoot  for  the  rigid  mode 
performance  in  Equation  (5-9)  is  calculated  from  this  plot.  Figure  5-7  (a) 
shows  the  deflections  at  the  end  of  each  links  with  the  solid  line  for  uie  and 
the  dotted  line  for  u2E.  Figure  5-7  (b)  shows  the  resulting  deflection  at  the 
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(a)  Joints  angles 


Figure  5-6  Rigid  mode  time  response  of  the  structure  (D1  and  D2=0.18m) 
(a)  Joint  angles  (0 1 : solid  line,  02:  dotted  line) 

(b)  Coordinate  trajectory  of  end  point 
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(a)  Deflections  at  end  of  each  link 


(b)  Deflection  at  the  end-effector 


Figure  5-7  Flexible  mode  time  response  of  the  structure  (Dl,  D2=0.18m) 
(a)  deflections  at  the  end  of  each  link 
(b)  deflection  at  the  end-effector 
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end-effector  as  obtained  by  using  Equation  (5-10).  The  maximum  value  of 
the  deflection  from  this  plot  is  the  measure  of  performance  of  the  flexible 
mode  in  Equation  (5-10). 

Three  new  optimized  systems  with  controller  effects  are  also 
investigated  with  the  same  controller  and  the  same  step  input  command. 
The  results  are  compared  in  Table  5-1  by  using  the  overshoot  of  the  rigid 
mode  and  the  maximum  deflection  of  the  flexible  mode.  The  values  in 
parentheses  are  the  percent  difference  in  responses  between  the  initial 
structure  and  the  structure  designed  with  consideration  of  the  controller 
effects. 


Table  5-1  System  performances  of  the  optimized  systems  with  clamped  free 
model 


Controller 

Dl(m) 

D2(m) 

OS(%) 

Uend(mm) 

% avg. 

0.18 

0.18 

4.3997 

20.6 

0 

fnrl 

0.17 

0.15 

4.0162(-8.72%) 

27.8(34.9%) 

13.1 

kq_r  1 

0.16 

0.15 

4.01  88(-8 . 66%) 

32.6(58.3%) 

24.8 

mq_rl*kq  rl 

0.19 

0.15 

4.0190(-8.65%) 

21.0(1.9%) 

-3.4 

All  structural  designs  incorporating  controller  effects  decreased  the 
overshoot  of  the  rigid  mode  about  8.7  percent  so  that  the  performance  of 
the  rigid  mode  is  improved.  The  flexible  mode  response  showed  worse 
response  due  to  increased  vibration.  The  third  scheme,  which  used  the 
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product  of  the  modal  mass  and  modal  stiffness,  showed  the  smallest 
vibration  increase.  The  percent  average  change  of  the  rigid  and  flexible 
modes  are  listed  in  last  column  as  a total  performance  index  based  on  equal 
importance  of  the  two  modes.  Based  on  the  percent  average,  the  last 
design  shows  better  performance  compared  to  the  initial  structure.  This 
table  implies  that  the  impulse  response  provides  the  best  approach  for 
modifying  a given  structural  design. 

The  optimization  using  the  product  of  the  modal  mass  and  modal 
stiffness  is  investigated  further  by  changing  the  scale  factor  SF3  in 
Equation  (5-8).  The  resulting  optimal  points  are  plotted  in  Figure  5-8  with 
the  scale  factor  SF3.  When  the  scale  factor  decreases,  the  effects  of  the 
rigid  mode  controller  increase  so  that  the  diameter  of  the  first  link  is 
increased  and  that  of  the  second  link  is  decreased,  as  illustrated  Figure  5-8. 
When  SF3  is  0.2,  the  resulting  structure  has  Dl=0.24m  and  D2=0.13m;  this 
structure  showed  better  response  as  shown  in  Table  5-2.  The  system 
performance  is  improved  by  approximately  13  percent  in  both  modes.  This 
shows  that  careful  consideration  should  be  given  to  the  selection  of  the 
scale  factor  in  Equation  5-8. 

Further  study  was  undertaken  for  the  clamped  mass  model  with  the 
initial  structure  Dl=0.18m  and  D2=0.16m  shown  in  Figure  4-8.  All 
procedures  to  include  the  controller  effects  are  exactly  the  same  as  those 
followed  for  the  clamped  free  model.  The  controller  gains  are  calculated 
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Figure  5-8  Effect  of  scale  factor  on  optimal  system  with  clamped  free  model 
(The  results  are  shown  for  SF3=  0.1,  0.2,  0.4  and  0.7  respectively) 


Table  5-2  System  performances  of  the  optimized  systems  with  clamped  free 
model 


Controller 

Dl(m) 

D2(m) 

OS(%) 

Uend(mm) 

% avg. 

0.18 

0.18 

4.3997 

20.6 

0 

mq_r  1 *kq_r  1 

0.24 

0.13 

3 . 8453(- 12.6%) 

1 8.0(- 12.6%) 

-12.6 

based  on  Equations  (5-2)  and  (5-3).  The  proportional  gains  are  Kpl=4100 
and  Kp2=800.  The  derivative  gains  are  Kvl=20500  and  Kv2=4000.  The 
controller  effects  on  the  design  stage  were  found  to  be  best  when  the 
product  of  the  modal  mass  and  modal  stiffness  is  included  in  the  design 
stage  by  using  Ug  in  Equation  (5-8).  The  scale  factor  SF3  was  0.4008 
based  on  Equation  (4-4)  and  the  resulting  optimal  structure  was  Dl=0.19m 
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and  D2=0.14m.  The  performance  of  this  structure  is  compared  to  the 
initial  system  in  Table  5-3  with  10  degree  step  inputs  on  each  joint.  The 
effects  of  the  scale  factor  were  investigated  further.  The  optimal  diameters 
plotted  in  Figure  5-9  are  obtained  by  changing  the  scale  factor  SF3.  This 
plot  shows  the  same  trend  as  in  the  clamped  free  model.  Decreasing  the 
scale  factor  increases  the  effect  of  the  rigid  mode  and  causes  the  diameter 
of  the  first  link  to  increase  and  that  of  the  second  link  to  decrease.  The 
optimal  structure  is  chosen  with  the  scale  factor  SF3  0.3  from  Figure  5-9 
with  Dl=0.20m  and  D2=0.13m.  This  system  shows  an  improved  response 
as  given  in  Table  5-3.  This  again  suggests  that  the  scale  factor  should  be 
chosen  carefully.  The  resulting  system  shows  higher  improvement  in  both 
the  rigid  and  flexible  modes  through  the  structural  modification 
incorporating  controller  effects. 

The  optimal  structure  of  the  clamped  free  model  has  diameters  of 
0.23m  and  0.13m  for  the  first  and  second  links  respectively.  Another 
optimal  structure  of  the  clamped  mass  model  has  Dl=0.2m  and  D2=0.13m 
so  that  two  different  models  show  different  optimal  diameters  for  the  first 
link.  One  reason  for  this  is  the  dependence  of  the  optimal  structure  on  the 
initial  structure.  The  optimal  relationship  between  D1  and  D2  in  Figure  5- 
9 is  controlled  by  changing  the  scale  factor,  which  prevents  evaluating  any 
structure  diverging  from  that  optimal  relationship  line.  The  performance  of 
the  structure  of  the  clamped  mass  model  can  be  improved  further  by 
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increasing  the  diameter  of  the  first  link  while  maintaining  the  size  of  the 
second  link,  diverging  from  the  optimal  ratio  derived  from  structural 
criteria. 


Figure  5-9  Effect  of  scale  factor  on  optimal  system  with  clamped  mass  model 
(The  results  are  shown  for  SF3=  0.1,  0.2,  0.3  and  0.8  respectively) 


Table  5-3  System  performances  of  the  optimized  systems  with  clamped 
mass  model 


Controller 

D 1 (m) 

D2(m) 

OS(%) 

ucnd(mm) 

% avg. 

0.18 

0.16 

4.1470 

25.9 

0 

mq_rl  *kq_r  1 

0.19 

0.14 

3.9233(-5.4%) 

24.5(-5.4%) 

-5.4 

mq_rl  *kq_rl 

0.20 

0.13 

3 . 8290(-7. 7%) 

2 1 9(- 1 5.4%) 

-11.6 

Conclusion 
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This  chapter  proposed  a design  methodology  that  includes  controller 
effects  in  the  design  stage.  This  study  shows  the  assumed  mode  method 
easily  includes  the  effects  of  the  controller.  Two  possible  ways  of 
including  the  controller  in  design  optimization  are  through  time  or 
frequency  domain  analysis.  The  frequency  domain  approach  is  used  in  this 
study  because  it  generates  more  general  system  information  than  the  time 
domain  approach.  The  time  domain  approach  may  show  better  results 
through  more  effective  search  algorithms  but  will  provide  less  physical 
insight  into  the  system’s  dynamic  characteristics. 

A simple  PD-controller  was  found  to  be  an  effective  tool  for 
including  controller  effects  in  the  design  stage  by  taking  into  account  both 
the  rigid  and  flexible  modes.  The  optimization  schemes  used  were  based  on 
the  natural  frequency,  the  modal  stiffness,  and  the  product  of  the  modal 
mass  and  modal  stiffness  in  the  rigid  mode.  All  resulting  structures  showed 
better  rigid  mode  dynamics  by  5-13  percent  due  to  effects  of  the  controller. 
Different  levels  of  penalties  on  the  flexible  mode  depended  on  the  scheme 
used.  The  optimization  employing  impulse  response  showed  improved 
flexible  mode  response  when  appropriate  scale  factors  were  used. 

The  optimization  scheme  using  the  product  of  the  modal  mass  and 
modal  stiffness  showed  the  best  performance  with  scale  factor  0.2-0. 3, 
depending  on  the  assumptions  used  in  beam  modeling.  Emphasis  on  the 
effects  of  the  controller  decreased  the  diameter  of  the  second  link  and 
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diminished  flexible  mode  characteristics.  Therefore,  an  optimal  scale 
factor  should  be  chosen  carefully  for  improved  flexible  mode  performance. 
This  study  shows  that  a larger  first  link  and  a smaller  second  link  decreased 
overshoot  in  rigid  mode  dynamics.  Flexible  mode  performance,  however, 
showed  strong  dependence  on  the  mass  distribution  of  the  two  links. 


CHAPTER  6 

SUMMARY,  CONCLUSION,  AND  RECOMMENDATION 


Summary 

The  reported  integrated  design  approach  can  be  summarized  in  the 
following  way: 

Step  1:  Structural  design  (clamped  free  model) 

Given  the  link  lengths  LI,  L2,  t/D(thickness/diameter)  and  diameter 
constraints 

Find  the  diameters  D1  and  D2  which  minimize  the  following  objective 
function 


U,  = norm(M)  + SF,  x 


n°rm(—!— ) + SF2  * norm(— ' — ) 
fn  f fn  rf  , 


where  norm  = normalization  of  a matrix  with  respect  to  its  maximum  value 
SFi,  SF2  = the  scale  factor  based  on  Equation  (4-4) 
ffl_f  = the  first  flexible  mode  natural  frequency  of  the  manipulator 
with  joint-locked  as  a clamped  structure 
fn_rf  = the  first  flexible  mode  natural  frequency  of  the  manipulator 
with  joint-unlocked  as  a pinned  structure 
Step  2:  Proportional  controller  gain  design 
Given  the  optimal  diameters  D1  and  D2  from  step  1 
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Find  the  optimal  proportional  controller  gains  Kpl  and  Kp2  in  a selected 
domain  of  Kpl  and  Kp2  to  minimize  the  following  objective  function 


U4  = norm 


f 1_N 
'vfn  rl. 


+ WF,  x norm 


fn_  r2 


fn_r2_d  ) 


where  WFi  = the  weighting  factor 

fn  rl  = the  first  rigid  mode  natural  frequency 

fn_r2  = the  second  rigid  mode  natural  frequency 

fn_r2_d  = one  half  of  the  first  flexible  mode  natural  frequency 

with  joint-locked  based  on  D1  and  D2,  which  is  selected  as  a desired 

objective  for  the  second  rigid  mode  natural  frequency. 

Step  3:  Derivative  controller  gain  design 

Given  the  optimal  fn  rl  and  fn_r2  corresponding  to  the  optimal  values  of 
Dl,  D2,  Kpl,  and  Kp2 

Find  the  derivative  controller  gains  Kvl  and  Kv2  which  minimize  the 
following  objective  function 

f 

U5  = norm 

V 

where  C,\  = the  modal  damping  for  the  first  rigid  body  mode  corresponding 
to  the  optimal  values  of  Dl,  D2,  Kpl,  and  Kp2 
0.707  = the  desired  modal  damping  ratio. 

off-diag  of  [Cq]  = off-diagonal  terms  of  the  modal  damping  matrix 
Step  4:  Including  the  controller  effects  in  the  structural  design  (with 
consideration  of  the  rigid  mode  natural  frequency) 


0.707  \ 


+ 


WF2  x norm([off  - diag  of  [Cq]]) 
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Given  the  optimal  values  of  Kpl  and  Kp2  determined  from  step  2 
Find  the  design  values  of  D1  and  D2  that  minimize  the  following  objective 
function  U6  by  including  the  rigid  mode  controller  effects  on  the 
structural  design,  Ui  from  Step  1 


U6  = norm 


f \_2 

Ifn  rl. 


f f 1 1 ^ 

+ SB,  x norm  norm(M)  + SF,  x norm( )+SF2*norm( ) 

V V fn_f  ‘ fn_rf  Jy 


where  fn  rl  = the  first  rigid  mode  natural  frequency  with  fixed  Kpl  and 
Kp2  by  changing  D1  and  D2 
SF3  = the  scale  factor  based  on  Equation  (4-4) 

Step  5.  Including  the  controller  effects  (with  different  objective  functions) 
Step  4 is  repeated  using  the  first  rigid  mode  modal  stiffness  instead 
of  the  first  rigid  mode  natural  frequency.  The  objective  function  to  be 
minimized  is  therefore, 


f l ^ 

norm 

+ SF.  x norm 

^ kq_rlj 

V 

r 


1 


norm(M)  + SF,  x norm( ) + SF.  * norm( — - — ) 

V fn_f  fnrf J) 

where  kqrl  = the  modal  stiffness  of  the  first  rigid  mode 

Step  4 is  also  repeated  using  the  product  of  the  modal  mass  and  the 
modal  stiffness  from  the  first  rigid  mode  instead  of  the  first  rigid  mode 
natural  frequency.  The  objective  function  to  be  minimized  in  this  case  is 

U8  = norm(mq_rl  x kq_rl)  + SF3  x norm  norm(M)  + SF,  x norm( ) + SF,  *norm( ) 

v V fn_f  “ fn  rf . 

where  mqrl  is  the  modal  mass  of  the  first  rigid  mode 
Step  6:  Comparison  of  the  results 
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The  initial  optimum  structure  from  Step  1 and  the  three  optimized 
systems  from  Step  4 and  Step  5 are  compared  through  the  time  domain 
response  of  the  manipulator  to  a step  input  at  both  joints.  The  rigid  and 
flexible  mode  responses  are  compared  with  respect  to  minimization  of 
vibration.  The  results  showed  that  the  objective  function  Us  gives  the  best 
design  in  this  respect. 

Step  7:  Effect  of  the  scale  factor 

Changing  the  scale  factor  SF3  in  U8  from  0.5671  to  0.2  achieves 
better  results  in  the  time  domain  response  to  a step  input  due  to  the  change 
of  the  design  diameters  from  Dl=0.19m  and  D2=0.15  to  Dl=0.24m  and 
D2=0.13m.  This  demonstrates  that  careful  consideration  should  be  given 
to  the  scale  factor  selection  procedure. 

Step  8:  Effect  of  different  model  (clamped  mass  model) 

The  beam  model  is  changed  from  the  clamped  free  model  to  the 
clamped  mass  model.  Steps  1-3  are  repeated  to  find  the  initial  structure 
and  the  controller  gains.  The  initial  structure  in  this  case  has  the  same  size 
for  the  first  link,  but  the  diameter  of  the  second  link  is  decreased  from 
0.18m  to  0.16m.  When  the  controller  effects  are  considered  by  using  U8  in 
Step  5,  which  includes  the  product  of  the  modal  mass  and  modal  stiffness, 
the  optimal  dimensions  changed  from  Dl=0.18m  and  D2=0.16m  to 
Dl=0.19m  and  D2=0.14m.  Further  improvement  also  was  obtained  when 
the  scale  factor  SF3  was  changed  from  0.4  to  0.2;  the  resulting  structure 
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has  Dl=0.20m  and  D2=0.13m.  This  suggests  that  the  value  of  SF3  in  U8 
should  be  changed  by  trial  and  error  or  by  a systematic  procedure  in  order 
to  obtain  the  best  results  in  the  time  domain  response. 

Step  9:  Effect  of  the  objective  function 

The  effect  of  the  objective  function  on  the  structural  design  is 
investigated.  Step  1 is  repeated  with  two  other  objective  functions  as 
follows: 

Case  1:  Structural  design  (clamped  free  model,  joint-free  case) 

( 1 -a)  Using  modal  stiffness 

The  objective  function  is  formulated  using  the  modal  stiffness  of  the 
first  flexible  mode  with  general  torque  inputs  on  both  joints. 


U2  = norm(M)  + SF,  x 


norm( — ) 
kq 


w/  T1 


+ SE  * norm( — ) 
kq 


v/  Tl' 


where  T1  = the  general  torque  input  at  the  first  joint 

T2  = the  general  torque  input  at  the  second  joint. 

(1-b)  Using  the  product  of  the  modal  mass  and  the  modal  stiffness 

The  objective  function  is  formulated  using  the  product  of  the  modal 
mass  and  modal  stiffness  of  the  first  flexible  mode  with  general  torque 
inputs  on  both  joints. 


U3  - norm(M)  + SF,  x 


norm( 


mq  x kq 


+ SF2  * norm( X- 

w/  ti  mq  x kq 


w/  T2' 


The  difference  between  U2  and  U3  is  incorporating  the  modal  mass  in  the 
objective  function.  Including  the  modal  mass  with  torque  inputs  at  the 


107 

joints  changed  the  optimal  structure  from  Dl=0.18m  and  D2=0.18m  based 
on  U2  to  Dl=0.18m  and  D2=0.16m  based  on  U3. 

Case  2:  Structural  design  (clamped  free  model,  joint-locked  case) 

(2-a)  Using  modal  stiffness 

The  objective  function  is  formulated  using  the  modal  stiffness  of  the 
first  flexible  mode  with  general  disturbance  inputs  on  the  end  of  each  link. 
It  is  expressed  as: 


U2  = norm(M)  + SF,  x 


norm( — ) 

kq 


+ SF2  * norm(— ) 

w/di  kq 


' d2' 


where  dl  = the  general  disturbance  at  the  end  of  the  first  link 

d2  = the  general  disturbance  at  the  end  of  the  second  link. 

(2-b)  Using  the  product  of  the  modal  mass  and  the  modal  stiffness 

The  objective  function  in  this  case  is  formulated  as  follows  using  the 
product  of  the  modal  mass  and  the  modal  stiffness  of  the  first  flexible  mode 
with  general  disturbance  inputs  on  the  end  of  each  link. 


U3  = norm(M)  + SF,  x 


norm( 


mq  x kq 


+ SF2  * norm( ) 

w/di  mq  x kq 


»/  d2' 


The  difference  between  U2  and  U3  is  incorporating  the  modal  mass. 
Including  the  modal  mass  with  general  disturbance  inputs  increased  the 
diameter  of  the  first  link  and  decreased  the  diameter  of  the  second  link 
from  D1=0. 17m  and  D2=0.15m  based  on  U2  to  Dl=0.19m  and  D2=0.14m 


based  on  U3. 


Conclusion 
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The  following  can  be  concluded  from  the  reported  study  based  on  the 
investigated  cases: 

1.  Dominant  flexible  modes  and  beam  modeling:  The  clamped  free  model 

and  the  clamped  mass  model  showed  almost  the  same  dominant  flexible 
mode  when  the  joints  are  locked.  When  the  joints  are  unlocked,  the 
dominant  flexible  modes  from  the  two  models  gave  different  results  and  the 
clamped  mass  model  showed  a much  lower  natural  frequency  in  the  flexible 
mode. 

2.  Effect  of  beam  modeling  on  the  optimal  line  in  the  design  domain:  The 
lines  giving  the  optimal  relation  of  the  two  link  diameters  were  different 
for  the  clamped  free  and  clamped  mass  models.  The  clamped  mass  model 
showed  a larger  difference  between  the  diameters  of  the  first  and  second 
links. 

3.  Effect  of  the  general  joint  inputs  on  the  optimal  line:  The  optimal  lines 
showed  different  results  for  the  different  joint  inputs.  The  optimal  lines 
indicate  that  the  link  subjected  to  an  input  should  be  bigger  than  the  other. 

4.  Effect  of  the  general  disturbances  at  the  link  ends:  The  effect  of  the 

general  disturbances  at  the  ends  of  the  links  can  be  evaluated  by 
combination  of  the  two  disturbances  on  the  first  flexible  mode  at  the  end  of 


each  link. 
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5.  Modal  mass  of  the  flexible  mode:  The  inclusion  of  the  modal  mass  in  the 
objective  function  increased  the  diameter  of  the  first  link  and  decreased  the 
diameter  of  the  second  link  for  the  same  mass.  The  results  were  the  same 
in  the  joint-locked  and  joint-free  cases. 

6.  Optimization  based  on  the  natural  frequency  and  the  impulse  response: 
When  the  joints  are  locked,  the  optimal  lines  for  the  relation  between  the 
two  link  diameters  were  almost  the  same  when  the  natural  frequency  or  the 
product  of  the  modal  mass  and  modal  stiffness  were  used  in  the  objective 
function. 

7.  Optimization  based  on  the  natural  frequency  and  the  modal  stiffness: 
When  the  joints  are  locked,  the  two  optimization  criteria  based  on  the 
natural  frequency  and  the  modal  stiffness  produced  different  optimal  lines. 
Using  the  natural  frequency  increased  the  difference  between  the  first  and 
the  second  link  diameters. 

8.  Controller  design:  The  pole  assignments  were  performed  to  find  the 

controller  gains  by  using  the  control  theory  and  the  optimization  theory. 
The  optimization  theory  was  used  to  make  the  first  rigid  mode  frequency  as 
high  as  possible  and  to  uncouple  the  modal  equations  of  the  rigid  mode. 

9.  Controller  and  rigid  mode  parameters:  The  virtual  structural  parameters 
for  the  rigid  mode  were  calculated  by  using  the  PD  controller. 
Consequently,  the  resulting  system  has  mass,  damping,  and  stiffness  for 
both  the  rigid  and  flexible  modes. 
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10.  Optimization  with  the  controller:  The  controller  is  included  in  the 

design  stage  to  modify  the  structure  based  on  the  natural  frequency,  the 
modal  stiffness,  and  the  product  of  the  modal  mass  and  modal  stiffness  of 
the  rigid  mode.  The  product  of  the  modal  mass  and  modal  stiffness 
produced  best  results  with  respect  to  reducing  the  vibration  by  increasing 
the  first  link  diameter  and  decreasing  the  second  link  diameter.  The 
resulting  system  showed  improved  dynamic  characteristics  for  both  the 
rigid  and  flexible  modes. 

11.  Effect  of  the  rigid  mode  modal  mass:  The  modal  mass  of  the  rigid 

mode  has  not  previously  received  much  attention  in  the  design  stage.  This 
study  shows  that  the  modal  mass  plays  an  important  role  in  both  the  rigid 
and  flexible  mode  responses. 

12.  Search  algorithm:  When  the  controller  is  included  in  the  design  stage, 
the  optimal  parameters  of  the  structure  are  determined  by  following  the 
optimal  lines  in  the  design  domain  and  changing  the  scale  factors.  This  is 
an  inherent  limitation  of  the  search  method  used  to  find  a better  structure. 
Accordingly,  it  is  expected  that  a search  algorithm  which  explores  the 
entire  design  space  would  produce  better  solutions. 

Recommendation 

The  followings  are  recommendations  for  future  investigation. 

1.  Problem  solving  approach:  Although  the  proposed  design  procedure  for 
the  structure  with  controller  effects  produced  good  results,  it  is  not 
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necessarily  the  best  way  to  design  a manipulator  with  optimized 
performance  since  the  controller  design  is  based  on  the  frequency  domain 
analysis.  A time  domain  design  approach  with  fewer  constraints  and 
searching  the  entire  design  space  for  the  optimum  design  is  recommended 
for  future  work  in  order  to  guarantee  the  best  performance  for  the 
integrated  system. 

2.  Configuration  and  task  effects:  The  effects  of  the  change  of  manipulator 
structural  configuration  and  incorporating  the  specified  tasks  in  the 
optimization  procedure  should  be  considered  for  developing  robust  system 
design. 

3.  Condition  at  the  end-effector:  The  effects  of  additional  mass  and 

applied  forces  at  the  end-effector  can  be  important  factors  for  practical 
robust  system  design.  This  should  also  be  incorporated  in  the  optimum 
design  procedure. 

4.  Condition  at  the  joints:  The  controller  at  the  joints  can  change  the 

dynamic  characteristics  of  the  mechanical  system.  The  flexibility  of  the 
joints  also  can  significantly  influence  the  dynamics  of  the  system  and 
should  be  considered  in  future  study. 

5.  Trade-off  analysis:  Trade-off  between  the  different  design  objectives 
plays  an  important  role  in  weighing  the  effects  of  two  conflicting 
properties  by  the  scale  factor  selection.  More  practical  knowledge  on  the 
relative  merits  of  the  conflicting  properties  should  be  incorporated  for  the 
robust  design  of  real  world  manipulators  performing  specific  functions. 


APPENDIX  A 

SYSTEM  ENERGY  EQUATIONS 


A.  1 Kinetic  energy  equation 

T = ^(Jh  +Jo  +mJL:1)^  +~m1(qj1  +q,22)  + ^mj(0llifq11  +<f>nE  q12)2 
+ 6>,[(nw11  +mJL1^11£)q11  +(nw12  +mJL,^12£)q12] 

+ ^-(m2  +mp)L2,^  + ~(m2  +mp)(^11J?qn  + <f)X2E  q12)2 

+^K  +mp)^(^iurqi1  +^i2^q,2)2 

+ ^(Joi  +Jp)(^i  +02  + u ;E)2  +^-m2(q2,  + qL)  + ^mp(^21Eq2]  + </>22Eq22)2 

+ (m2  + mp)L,^1  (<t>UEqn  +^12i?q12)  + (m2  + 2mp)^^-01(/91  + 02  + u;e)cos02 
+ LA  cos<92[(mp^21£.  +nq2i)q21  +(mp<^22E  + nq22)q22] 

~hA0i  +&2  +u;E)[(mp^21E  +nq21)q21  + (mp<£22ir  + nq22)q22]sin02 

+ (^iifi-qn  + ^i2£-qi2)(^i  +^2  + u,'E)(m2  +2mp)^cos(92 

+ (^n£-qn  +^2irqi2)[(mp02i£ + nq2i)q2i  +(mp^22£ + nq22  )q22]cos<92 

~(^ii!?qn  +^i2^qi2)(^i  +^2  +uiE)[(mp^21£  + nq21)q21  + (mp</>22E  + nq22)q22]sin<92 

+ (m2  +2mpX^lu?qn  + ^12i?q12)01(01  +02  +u[E)^-sm02 

+ (<t>uE<[u  +^i2£qi2)^i[(mp^2iE  +nq21)q2,  +(mp^22£  + nq22)q22]sin<92 

+(^ii£q,i  +<PuE(\nW^^  +02  +u;E  )[(  mP^2iiT + nq2i)q2i  +(mP^22£  +nq22)q22]c°s02 
+ 0,  +d2  +u1'E)[(nw21+mpL2^21£)q21+(nw22  + mpL2^22i?)q22] 

+ ^JP<A  +^2  +u1'E+u'E)2 
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where 


f 2 nijLj  , +R,  0) 

Jn  = x,dm  = — L + = — 

0 J 1 ^ 4 


J01  = Jx2dm  + mp(L2)2  = + 

mi  3 

^ije  = 0t]  at  the  end  of  the  link 


Li  , m2(R2i+R2o) 


+ mP(L2)2 


rl 2d-  2d : 

nq,j  = J0m,^y(x)dx  = m,  — 1 


2a ■ 2a. 

Lj 

(a;  = 0.7341,  a2  = 1.0185  for  clamped  free  model) 
nwu  = J0m,x^lj(x)dx  = m,  — = —j-  (L]  =Xf) 


A.  2 Potential  energy  equation 
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dx 
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APPENDIX  B 
SYSTEM  EQUATIONS 


These  are  the  linearized  system  equations  utilized  in  Chapter  3 and  the  components 
of  the  mass,  damping,  stiffness,  and  torque  coefficient  matrices  are  listed. 


MiA  + M126>2  + Muqu  + M14<712  + M15<721  + UX6q22  + b,#,  - T, 

M2i6>i  + M226>2  + M23^u  + M244r12  + M25<?21  + M 26q22  + b 202  = T2 
Mj,  + M32e2  + M 33qu  + M34qn  + M35q2]  + M 36q22  + C ,qu  + K,qu  - T2^1E+F^11E 

M4A  + M^2  + M43^n  + M^12  + M45^21  + M46^22  + C2qu  + K2q12  = T^+F^ 

Mj,  + M J2  + M 53qu  + M54qu  + M 55q2l  + M56q22  + C3q2X  + K3q21  = F2^21E 

M616>,  + M6202  + M634fu  + M64^r12  + M654r21  + M66«?22  + C4<?22  + K4q22  = F 2</>22E 


where 

My  = MJt  i,j=  1,2. ..6 

Mn  = (Jh  + J0  + mjL2,)  + (m2  +mp)L^  + (Jol  +Jp)  + (m2  +2mp)L1L2 
= (Joi  +JP)  + (m2  + 2mp)^^- 

M13=  (nwn  +mjL1^]1E)  + (m2+mp)L^ns  + (<f>UE  + L,^1E)(m2  + 2mp)^- 
(J  h2  +Jo2  +Jp  + mp  L2)^U£ 

Mi4=  (nwn +mjL,^12E)  + (m2+mp)L^12E  + ^12E(m2  + 2mp)^- 


M15  = L,mp2]  + (nw21  +mpL2</>2XE) 
Mi6=  LimP22  + (nw22+mpL2^22E) 
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M22  = (J01  +Jp) 
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^23  — ^UE(m2  +^mp)  ^ 

M24  = ^12F(m2  +2mp)^- 

M25  = (nw2|  + mpL2^21£.) 

M26  = (nw22  + mpL2^22£) 

M33=  m,  + (mJ+m2+mp)^llir2  + (Jh2  + Jo2  + Jp  +mpL22)^[lff2 

M34  = (m,  +m2  + m v)<t>nE<l>UE  + (Jh2  +Jo2  +Jp  +mpL \WXXE<t>\2E 
M35  = ^1Ufmp21 

M36  = ^U£mP22 

M44  = m,  + (mj  + m2  + mp)^12E2  + (Jh2  +Jo2  +Jp  +mpL2)^2E2 

M45=  ^12FmP2l 
M46  = ^122TmP22 

M55=  m2+m  v</>22lE  + J p(/,'2]E 

^56  ~ mp(/>  IXE&IIE  +Jp  ^IXE^'riE 

M66  = m2  + m p<t>  222E  + Jp^22£. 

Ku  = EI,|oL'(^''(x))2dx  = EI.^L,  (K,  = Ku,  K2  = K12,  K3  = K21,  K4  = K22) 

M«  = jo1'mi(^(x))2dx  = miLi  =m,  (M,  = Mu,  M,  =M12,  M3  =M21,  M4  =M22) 
bn  = 0 
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Cn  = 

-if* 

Wn 

=24V^X 
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-IT  C “ 
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~ ^11E> 

TC 

1 ^42 

— ^12E 
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= ^11E  3 

TC 

1 ^43 

= 12E 
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— ^ 21E  ’ 

TC 
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APPENDIX  C 

FINITE  ELEMENT  PROGRAM 


This  is  the  finite  element  program  to  check  the  structural  characteristics  of  the  two 
link  manipulator.  The  session  file  of  COSMOS  is  listed  for  the  example  in  the  Chapter  2. 


PLANE,Z,0,1, 

SCALE, 0, 

VIEW, 0,0, 1,0, 

MPROP,  1, DENS,  1744, EX,  145. 3E9,EY,  145. 3E9, 
CRPCORD,  1 ,0, 1 0,0,7, 1 0,0,7, 1 0,0, 
CRPCORD,2,7, 1 0,0, 1 4, 1 0,0, 1 4, 1 0,0, 

EGROUP,  1 ,BEAM2D, 0,0, 0,0, 0,0,0, 
BMSECDEF,  1,1,3, 1,7,0. 19,0. 19*0.02,0,0,0,0,0, 
M_CR, 1,1, 1,2,7, 1, 

BMSECDEF,  1,2,3, 1,7,0. 1 5,0. 1 5*0.02,0,0,0,0,0, 
M_CR,2,2,1,2,7, 1, 

EGROUP,2,  MASS,  0,0, 0,0, 0,0,0, 

RCONST,2,3, 1,7,50,50,0,0,0,0. 1,0, 

M_PT,2,2, 1, 

RCONST,2,4, 1 ,7, 1 00, 1 00,0,0,0, 1 00,0, 
M_PT,3,3,1, 

DND,1,AL, 0,1,1, 

NMERGE,  1 , 1 8, 1 ,0.000 1 ,0,0,0, 

NCOMPRESS,  1,16, 

A_FREQ,4,S,  1 6, 0,0, 0,0,  IE-005,0,  IE-006,0,0,0,0, 
R FREQ; 

FREQLIST; 
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APPENDIX  D 

GENERAL  PROGRAM  LISTINGS 


This  appendix  includes  programs  for  controller  design,  system  parameters,  mode 
shapes,  mass  matrix,  and  stiffness  matrix. 

D.  1 This  sub-program  is  to  find  the  proportional  gains  based  on  the  Equation  (5-2). 
Diameter=[Dl_o  D2_o]; 
sys_par;  mode  shp;  m linear;  k f line; 
fn=sort(sqrt(eig(inv(M)*K))/2/pi)'; 
fn_f=sort(sqrt(eig(inv(M(3 :6,3 :6))*K(3 :6,3 :6)))/2/pi)'; 
fh_r_max=min(fn_f)  *0.5; 
n=0;div=100; 

Kp  1 _min=  1 00;Kp  1 _max=  1 0000;d_Kp  1 =(Kp  1 _max)/div; 

Kp2_min=  1 00;Kp2_max=  1 0000;d_Kp2=(Kp  1 max)/div; 
for  Kp  1 =Kp  1 min : d_Kp  1 : Kp  1 max, 
n=n+l;  m=0; 

for  Kp2=Kp2_min:d_Kp2:Kp2_max, 
m=m+l; 

K(l,l)=Kpl;  K(2,2)=Kp2; 

fn_r=sort(sqrt(eig(inv(M(l  :2, 1 :2))*K(  1 :2, 1 :2)))/2/pi)'; 
fn  1 =fn_r(  1 );fn2=fnr(2); 
objl(n,m)=l/fnl; 
obj2(n,m)=abs(  1 -fn2/fn_r_max); 
end 
end 

obj  1 1 =obj  1 /max(max(obj  1 ));obj22=obj2/max(max(obj2)); 

U4=obj  1 l+obj22;U4=U4/max(max(U4)); 

D.2  This  sub-program  is  to  find  the  derivative  gains  based  on  the  Equation  (5-3). 

K(1 , 1 )=Kp  1 ;K(2,2)=Kp2; 
n=0; 

Kv  1 _min=  1 00;Kv  1 _max=40000;  d_Kv  1 =(Kp  1 _max)/div; 

Kv2_min=  1 00;Kv2_max=40000;d_Kv2=(Kp  l_max)/div; 
for  Kv  1 =Kv  1 min : d_Kv  1 : Kv  1 max, 
n=n+l;  m=0; 

for  Kv2=Kv2_min:d_Kv2:Kv2_max, 
m=m+l; 
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C(l,l)=Kvl;  C(2,2)=Kv2; 

fn_r=sort(sqrt(eig(inv(M(  1 :2, 1 :2))*K(1 :2, 1 :2)))/2/pi)'; 
M_i=M(l:2,l:2);  K_r=K(l:2,l:2);  C_r=C(l:2,l:2); 
[v_r,d_r]=eig(inv(M_r)*K_r); 
diag_d=sort(diag(d_r)); 
for  nn=l  :2, 

if  (d_r(nn,nn)==  diag_d(l)) 
x_r(:,l)=v_r(:,nn); 
end 

if  (d_r(nn,nn)=  diag_d(2)) 
x_r(:,2)=v_r(:,nn); 
end 
end 

x_r(:,  1 )=x_r(:,  1 )/x_r(  1 , 1 );x_r(:,2)=x_r(:,2)/x_r(l  ,2); 
p_r=x_r; 

mq_r=diag(p_r'  * M r * p r) ; 
cq_r=diag(p_r'*C_r*p_r); 
kq_r=diag(p_r'*K_r*p_r); 
zeta  1 =cq_r(  1 )/(2  * sqrt(mq_r(  1 ) * kq_r(  1 ))); 
zeta2=cq_r(2)/ (2  * sqrt  (mq_r(2)  * kq_r(2))); 
Cq_mat=p_r'  * C_r  * p_r ; 
obj4(n,m)=abs(Cq_mat(  1,2)); 
obj5(n,m)=abs(l-zetal/0.707); 
end 
end 

obj44=obj4/max(max(obj4));obj55=obj5/max(max(obj5)); 

U5=obj44+obj55;U5=U5/max(max(U5)); 

D.3  This  sub-program  is  to  calculate  the  system  parameters. 
gr=9. 80665;  Ratiol=0.02;  Ratio2=0.02; 
thick  1 =Dl_o*  Ratio  1;  thick2=D2_o*Ratio2; 

D 1 _i=D  1 _o-2*thick  1 ; D2_i=D2_o-2 *thick2; 

Rl_o=D  l_o/2.  ;Rl_i=D  l_i/2.  ;R2_o=D2_o/2.  ;R2_i=D2_i/2. ; 
Al=pi*(Rl_oA2-Rl_iA2);  A2=pi*(R2_oA2-R2_iA2); 

LI  =7.;  L2=7.; 

Rho=1744;E=145.3e9; 

1 1 =pi/64 * (D 1 _oA4-D  1 _iA4);  I2=pi/64 * (D2_o A4-D2_iA4); 

ml=Rho*Al*Ll;m2=Rho*A2*L2;mh2=50; 

mp=100;Jp=100; 

Jh  1=0.1;  Jh2=0.1; 

JL 1 =m  1 /4 . * (R 1 _iA2+R  1 _o  A2)+m  1 * L 1 A2/3 . ; 

JL2=m2/4.  * ( R2_iA2+R2_o  A2  )+m2  * L2  A2/3 . ; 
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D.4  This  sub-program  is  to  calculate  the  system  mode  shape  based  on  Equation  (3-13) 
and  (3-14). 

clmp_mass=l;  % 1 for  clamped  mass  model,  0 for  clamped  free  model 
%First  link 

massr  1 =(mh2+m2+mp)/m  1 ; 

num=  1 ; freq_eq_old=  1 ; 
for  B_1=0. 01:0. 01:5 
no_payload=l+cos(B_l)*cosh(B_l); 

w_payl°ad=mass_rl*B_l*(cos(B_l)*sinh(BJ)-cosh(B_l)*sin(B_l)); 
freq_eq=no_payload+w_payload*clmp_mass; 
if(ffeq_eq*ffeq_eq_old)  < 0 
B_ll(num)=B_l; 
num=num+l; 
end 

freq_eq_old=freq_eq; 
if  num  = 3 
break 
end 
end 

BB1=B_11(1);  BB2=B_11(2); 

%BB1=1. 875104;  BB2=4. 694091;  %This  is  for  the  clamped  free  model. 

S S 1 =(cosh(BB  1 )+cos(BB  1 ))/(sinh(BB  1 )+sin(BB  1 )); 
SS2=(cosh(BB2)+cos(BB2))/(sinh(BB2)+sin(BB2)); 

%Second  link 
mass_r2=mp/m2; 

num=  1 ; freq_eq_old=  1 ; 
for  B_M). 01:0. 01:5 
no_payload=l+cos(B_l)*cosh(B_l); 

w jpayload=mass_r2  *B  _1  * (cos(B_l)  * sinh(B_l)-cosh(B  J)  * sin(B_l)); 
freq_eq=no_payload+w_payload  * clmpmass; 
if(freq_eq*freq_eq_old)  < 0 
B_1 1 (num)=B_l; 
num=num+l; 
end 

freq_eq_old=freq_eq; 
if  num  - 3 

break 
end 
end 

BB3=B_11(1);  BB4=B_ll(2); 

%BB3=BB1;  BB4=BB2;;  %This  is  for  the  clamped  free  model. 

SS3=(cosh(BB3)+cos(BB3))/(sinh(BB3)+sin(BB3)); 

SS4=(cosh(BB4)+cos(BB4))/(sinh(BB4)+sin(BB4)); 
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Phil  1 E=(cosh(BB  1 )-cos(BB  1 ))-SS  1 *(sinh(BB  1 )-sin(BB  1 )); 
Phi_12E=(cosh(BB2)-cos(BB2))-SS2*(sinh(BB2)-sin(BB2)); 
Phi_21E=(cosh(BB3)-cos(BB3))-SS3*(sinh(BB3)-sin(BB3)); 
Phi_22E=(cosh(BB4)-cos(BB4))-SS4*(sinh(BB4)-sin(BB4)); 

Phi_  1 1 E_P=BB  1 /L 1 *(sinh(BB  1 )+sin(BB  1 )-S  S 1 *(cosh(BB  1 )-cos(BB  1 ))); 
Phi_12E_P=BB2/Ll*(sinh(BB2)+sin(BB2)-SS2*(cosh(BB2)-cos(BB2))); 
Phi_21E_P=BB3/L2*(sinh(BB3)+sin(BB3)-SS3*(cosh(BB3)-cos(BB3))); 
Phi_22E_P=BB4/L2*(sinh(BB4)+sin(BB4)-SS4*(cosh(BB4)-cos(BB4))); 


D.5  This  sub-program  is  to  calculate  the  system  mass  matrix  based  on  Appendix  B 
%This  part  is  for  the  clamped  free  model, 
nql  l=2*SSl/BBl*ml;  nql2=2*SS2/BB2*ml; 
nq2 1 =2* SS3/BB3 *m2;  nq22=2*SS4/BB4*m2; 
nwl l=2/BBlA2*Ll*ml;  nwl2=2/BB2A2*Ll*ml; 
nw21=2/BB3A2*L2*m2;  nw22=2/BB4A2*L2*m2; 

%This  part  is  for  the  clamped  mass  model. 

C 1 =BB  1 /L 1 ;C2=BB2/L  1 ;C3=BB3/L  1 ;C4=BB4/L  1 ;ddxx=0. 0 1 ; 
x=0:ddxx:7; 

phi_xl=(cosh(C  1 *x)-cos(C  1 *x))-SS  1 *(sinh(C  1 *x)-sin(C  1 *x)); 
phi_x2=(cosh(C2*x)-cos(C2*x))-SS2*(sinh(C2*x)-sin(C2*x)); 
phi_x3=(cosh(C3  *x)-cos(C3  *x))-SS3  *(sinh(C3  *x)-sin(C3  *x)); 
phi_x4=(cosh(C4*x)-cos(C4*x))-SS4*(sinh(C4*x)-sin(C4*x)); 
summ  1 =phi_x  1 . *x*ddxx;summ  1 1 =sum(summ  1 ); 
summ2=phi_x2.  *x*ddxx;summ2 1 =sum(summ2); 
summ3=phi_x3.*x*ddxx;summ31=sum(summ3); 
summ4=phi_x4 . *x*  ddxx;  summ4 1 =sum(  summ4); 
summ5=phi_xl  *ddxx;summ5  l=sum(summ5); 
summ6=phi_x2  * ddxx;  summ6 1 =sum(  summ6); 
summ7=phi_x3  *ddxx;summ7 1 =sum(summ7); 
summ8=phi_x4*ddxx;summ81=sum(summ8); 
nwl  l=ml/Ll*summl  I;nwl2=ml/Ll*summ21; 
nw2 1 =m2/L2  * summ3 1 ;nw22=m2/L2  * summ4 1 ; 
nq  1 1 =m  1 /L 1 * summ5 1 ;nq  1 2=m  1/Ll  * summ6 1 ; 
nq2 1 =m2/L2  * summ7 1 ;nq22=m2/L2  * summ8 1 ; 

mp2 1 -mp*Phi_2 1 E+nq2 1 ;mp22=mp*Phi_22E+nq22;cos2isl  = 1 . ; 

M(l,l)=  Jh  1 +JL 1 +mh2  *L  1 A2+(m2+mp)*L  1 A2+  JL2+mp*L2A2+Jp 
+(m2+2*mp)*Ll*L2*cos2isl; 

M(l,2)=  Jh2+JL2+Jp+mp  *L2  A2+(m2+2  *mp)  * L 1 *L2/2 . * cos2is  1 ; 

M(l,3)=  (nwl  l+mh2*Ll*Phi_l  1E)+  (m2+mp)*Ll*Phi_l  IE  +Phi_l  IE 
*(m2+2*mp)*L2/2*cos2isl+(Jh2+JL2+Jp+mp*L2A2)*Phi_l  1E_P 
+Phi_l  lE_P*Ll*(m2+2*mp)*L2/2*cos2isl; 
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M(l,4)=  (nw  1 2+mh2*L  1 *Phi_l  2E)+  (m2+mp)*Ll*Phi_12E+Phi_12E 

*(m2+2*mp)*L2/2.  *cos2isl  +(Jh2+JL2+Jp+mp*L2A2)*Phi_l  2E_P 
+Phi_  1 2E_P  * L 1 * (m2+2  * mp)  *L2/2 . * cos2is  1 ; 

M(l,5)=  L 1 *mp2 1 * cos2is  1 +(nw2 1 +mp  * L2  * Phi_2 1 E)+  Jp*Phi  21E  P; 

M(l,6)=  L 1 * mp22  * cos2is  1 +(nw22+mp  * L2  *Phi_22E)+  Jp*Phi_22E_P; 

M(2, 1)=M(1,2); 

M(2,2)=  Jh2+JL2+Jp+mp*L2A2; 

M(2,3)=  Phi_l  lE*(m2+2*mp)*L2/2*cos2isl+(Jh2+JL2+Jp+mp*L2A2)*Phi_l  1E_P; 

M(2,4)=  Phi_12E*(m2+2*mp)*L2/2*cos2isl+(Jh2+JL2+Jp+mp*L2A2)*Phi_12E_P 

M(2,5)=  (nw2 1 +mp*  L2  * Phi_2 1 E)+  Jp*Phi_21E_P; 

M(2,6)=  (nw22+mp*L2*Phi_22E)+  Jp*Phi_22E_P; 

M(3,1)=M(1,3);  M(3,2)=M(2,3); 

M(3,3)=  ml+mh2*Phi_l  lEA2+(m2+mp)*Phi_l  lEA2+2*(m2*L2/2+mp*L2) 

*Phi_l  lE*Phi_l  lE_P*cos2isl+(Jh2+JL2+Jp+mp*L2A2)*Phi_l  IE  PA2; 

M(3,4)=  mh2*Phi_l  lE*Phi_12E+(m2+mp)*Phi_l  lE*Phi_12E+(m2*L2/2 

+mp*L2)*(Phi_l  lE*Phi_12E_P+Phi_12E*Phi_l  lE_P)*cos2isl+(Jh2+JL2 
+ Jp+mp  *L2A2)  * Phi_  1 1 E_P*Phi_l  2E_P; 

M(3,4)=  (m2  *L2/2+mp  *L2)  * (Phi_  1 lE*Phi_12E_P+Phi_12E*Phi_l  1E_P) 

* cos2is  1 +(Jh2+JL2+Jp+mp * L2 A2) * Phi_  1 lE_P*Phi_12E_P;(CM  model) 

M(3,5)=  Phil  1 E * mp2 1 * co  s2is  1 +(nw2 1 + Jp  * Phi_2 1 E_P+mp  * L2  * Phi_2 1 E) 

*Phi_l  1E_P; 

M(3,6)=  Phil  lE*mp22*cos2isl+(nw22+Jp*Phi_22E_P+mp*L2*Phi_22E) 

*Phi  1 IE  P; 

M(4, 1)=M(1,4);  M(4,2)=M(2,4);  M(4,3)=M(3,4); 

M(4,4)=  mh2  * P hi_  1 2E  * Phi_  1 2E+m  1 +(m2+mp)  * Phi_  1 2E*  Phi_  1 2E+2  * (m2  *L2/2 
+mp*L2)*Phi_12E*Phi_12E_P*cos2isl+(Jh2+JL2+Jp+mp*L2A2) 
*Phi_12E_PA2; 

M(4, 5 )=  Phi  1 2E*mp2 1 * cos2is  1 +(nw2 1 +Jp  * Phi  2 1 E_P+mp  * L2  * Phi_2 1 E) 
*Phi_12E_P; 

M(4,6)=  Phi_  1 2E*  mp22  * cos2is  1 +(nw22+Jp  * Phi_22E_P+mp  * L2  * Phi_22E) 
*Phi_12E_P; 

M(5,1)=M(1,5);M(5,2)=M(2,5);M(5,3)=M(3,5);M(5,4)=M(4,5); 

M(5,5)=  m2+mp  * Phi_2 1 E A2+  Jp*Phi_21E_PA2; 

M(5,6)=  mp*Phi_21E*Phi_22E+  Jp*Phi_21E_P*Phi_22E_P; 

M(5,6)=  Jp*Phi_2 1 E_P*Phi_22E_P;(CM  model) 

M(6,1)=M(1,6);M(6,2)=M(2,6);M(6,3)=M(3,6);M(6,4)=M(4,6);M(6,5)=M(5,6); 

M(6,6)=  m2+mp*Phi_22EA2+  Jp*Phi_22E_PA2; 
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D.6  This  sub-program  is  to  calculate  the  system  stiffness  matrix  based  on  Appendix  B. 
K=zeros(6,6); 

%This  part  is  stiffness  matrix  elements  for  the  clamped  free  model. 

EI1=E*I1;  EI2=E*I2; 

K(  1 , 1 )=0;K(  1 ,2)=0;K(2, 1 )=0;  K(2,2)=0; 

K(3,3)=1.875104A4*EI1/L1A3; 

K(4,4)=4. 69409 1 A4*EI  1 /L 1 A3 ; 

K(5 , 5 )=  1 . 8 7 5 1 04 A4  * EI2/L2  A3 ; 

K(6, 6)=4 . 69409 1 A4  *EI2/L2A3 ; 

%This  part  is  stiffness  matrix  elements  for  the  clamped  mass  model. 

C 1=BB  1/L 1 ;C2=BB2/L  1 ;C3=BB3/L1  ;C4=BB4/L  1 ;ddxx=0.0 1 ; 
x=0:ddxx:7; 

phi_ddxl=((cosh(Cl  *x)+cos(C  1 *x))-SS  1 *(sinh(Cl  *x)+sin(Cl  *x)))*ClA2; 
phi_ddx2=((cosh(C2  *x)+cos(C2  *x))-S  S2  * (sinh(C2  *x)+sin(C2  *x)))  * C2A2; 
phi_ddx3=((cosh(C3  *x)+cos(C3  *x))-SS3  *(sinh(C3  *x)+sin(C3  *x)))*C3A2; 
phi_ddx4=((cosh(C4*x)+cos(C4*x))-SS4*(sinh(C4*x)+sin(C4*x)))*C4A2; 
summ_K3=(phi_ddxl  ,A2)*ddxx;  summ_K33=sum(summ_K3); 
summ_K4=(phi_ddx2 . A2)  * ddxx;  summ_K44=sum(summ_K4); 
summ_K5=(phi_ddx3.A2)*ddxx;  summ_K55=sum(summ_K5); 
summ_K6=(phi_ddx4 . A2)  * ddxx;  summ_K66=sum(summ  K6); 

K(3 ,3  )=summ_K3  3 * El  1 ; 

K(4,4)=summ_K44*EI  1 ; 

K(5,5)=summ_K55*EI2; 

K(6,6)=summ_K66*EI2; 
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